; Amiga-side full featured AHI driver for WinUAE 4.3.1+ UAESND sound board.
	; by Toni Wilen (c) 2019-2020

	; License: GPL version 2 or any later version.
	
	incdir	sys:programming/asm/includes/

	include	exec/exec.i
	include exec/exec_lib.i
	include exec/libraries.i
	include exec/ports.i
	include	devices/ahi.i
	include	libraries/ahi_sub.i
	include libraries/configregs.i
	include libraries/configvars.i
	include utility/hooks.i
	include hardware/intbits.i
	include	utility/utility.i
	include	utility/hooks.i

DEBUG EQU 1
DEBUG_ADDR EQU $bfff00

VERSION EQU 4
REVISION EQU 1
VERSION_STRUCT EQU 1

call MACRO
	jsr	_LVO\1(a6)
	ENDM

	STRUCTURE UAESNDHW,$80
	ULONG base_uae_version
	UWORD base_snd_version
	UWORD base_snd_revision
	ULONG base_frequency
	UBYTE base_max_channels
	UBYTE base_max_actual_channels
	UBYTE base_max_streams
	UBYTE base_pad1
	ULONG base_ram_offset
	ULONG base_ram_size
	STRUCT base_reserved1,$48
	ULONG base_stream_allocate
	ULONG base_stream_latch
	ULONG base_stream_unlatch
	ULONG base_pad2
	ULONG base_stream_enable
	ULONG base_stream_intena
	ULONG base_stream_intreq

	STRUCTURE UAESNDSet,0
	UWORD set_flags
	UWORD set_format
	APTR set_pointer
	ULONG set_length
	ULONG set_frequency
	APTR set_repeat_pointer
	ULONG set_repeat_length
	UWORD set_repeat_count
	UWORD set_volume
	APTR set_next_pointer
	UBYTE set_channels
	UBYTE set_type
	UBYTE set_intena
	UBYTE set_mask
	UWORD set_hpan
	UWORD set_dpan
	APTR set_pointer_original
	ULONG set_length_original
	; extra
	ULONG set_offset
	UWORD set_sample_size
	LABEL UAESNDSet_SIZEOF	

STREAM_START = $100
STREAM_OFFSET = $100

	STRUCTURE UAESNDStream,0
	STRUCT UAESNDSetCurrent,$40
	STRUCT UAESNDSetLatched,$40
	APTR stream_sample_pointer
	UBYTE stream_pad01
	UBYTE stream_pad02
	UBYTE stream_pad03
	UBYTE stream_intreq
	UBYTE stream_pad04
	UBYTE stream_pad05
	UBYTE stream_pad06
	UBYTE stream_alt_intreq
	UBYTE stream_pad07
	UBYTE stream_pad08
	UBYTE stream_pad09
	UBYTE stream_master_intena
	UBYTE stream_pad10
	UBYTE stream_pad11
	UBYTE stream_pad12
	UBYTE stream_status
	ULONG stream_timer1_frequency
	ULONG stream_pad13
	ULONG stream_pad14
	APTR stream_sample_pointer_imm

	STRUCTURE sound,0
	APTR	so_Address
	ULONG	so_Length
	UWORD so_Type
	UWORD so_Samplesize
	LABEL	sound_SIZEOF

	STRUCTURE channel,0
	APTR ch_set_current
	STRUCT ch_UAESNDSet1,UAESNDSet_SIZEOF
	STRUCT ch_SndMsg,AHISoundMessage_SIZEOF
	LABEL	channel_SIZEOF

	STRUCTURE UAESNDBase,LIB_SIZE
	UBYTE	ub_Flags
	UBYTE	ub_Pad1
	UWORD	ub_Pad2
	APTR	ub_SysLib
	ULONG	ub_SegList
	ULONG	ub_Base
	APTR	ub_ConfigDev
	APTR	ub_UtilBase
	LABEL	UAESNDBase_SIZEOF

	STRUCTURE UAESND,0
	ULONG	p_Base
	APTR p_UAESNDBase
	UWORD p_DisableCount
	BOOL p_intadded
	APTR p_AudioCtrl
	ULONG p_SoundSize
	APTR	p_Sounds
	APTR p_Channels
	ULONG p_ChannelSize
	ULONG p_DriverDataSize
	APTR p_ChannelInfo
	UWORD p_StreamCnt
	UWORD p_Pad1
	STRUCT p_Interrupt,IS_SIZE
	LABEL UAESND_SIZEOF	

Start:
	moveq	#-1,d0
	rts

RomTag:
	DC.W RTC_MATCHWORD
	DC.L RomTag
	DC.L EndCode
	DC.B RTF_AUTOINIT
	DC.B 4				;version
	DC.B NT_LIBRARY
	DC.B 0				;pri
	DC.L LibName
	DC.L IDString
	DC.L InitTable

LibName:
	dc.b "uaesnd.audio",0
	dc.b "$VER:"
IDString:
	dc.b "uaesnd.audio 4.1 (11.04.2020)",0
	cnop 0,4

InitTable:
	DC.L UAESNDBase_SIZEOF
	DC.L funcTable
	DC.L dataTable
	DC.L initRoutine

funcTable:
	dc.l Open
	dc.l Close
	dc.l Expunge
	dc.l Null

	dc.l AHIsub_AllocAudio
	dc.l AHIsub_FreeAudio
	dc.l AHIsub_Disable
	dc.l AHIsub_Enable
	dc.l AHIsub_Start
	dc.l AHIsub_Update
	dc.l AHIsub_Stop
	dc.l AHIsub_SetVol
	dc.l AHIsub_SetFreq
	dc.l AHIsub_SetSound
	dc.l AHIsub_SetEffect
	dc.l AHIsub_LoadSound
	dc.l AHIsub_UnloadSound
	dc.l AHIsub_GetAttr
	dc.l AHIsub_HardwareControl
	dc.l -1

dataTable:
	INITBYTE LN_TYPE,NT_LIBRARY
	INITLONG LN_NAME,LibName
	INITBYTE LIB_FLAGS,LIBF_SUMUSED|LIBF_CHANGED
	INITWORD LIB_VERSION,VERSION
	INITWORD LIB_REVISION,REVISION
	INITLONG LIB_IDSTRING,IDString
	DC.L		0

	IFD DEBUG=1
debugreturn
	move.l d0,DEBUG_ADDR
	move.l #debug_return,DEBUG_ADDR+4
	rts
debug_return
	dc.b "-> %x\n",0
	even
	ENDC

	IFD DEBUG=1
debug_setvol
	dc.b "SetVol(%u,%x,%x,%p,%x)\n",0
	even
	ENDC

	; UWORD channel D0
	; Fixed volume D1
	; sposition pan D2
	; struct AHIAudioCtrlDrv* A2
	; ULONG Flags D3

AHIsub_SetVol
	movem.l d2/a2,-(sp)

	IFD DEBUG=1
	lea DEBUG_ADDR,a0
	move.w d0,(a0)
	move.l d1,(a0)
	move.l d2,(a0)
	move.l a2,(a0)
	move.l d3,(a0)
	move.l #debug_setvol,4(a0)
	ENDC

	move.l ahiac_DriverData(a2),a2

	move.w d0,d2
	mulu #channel_SIZEOF,d0
	move.l p_Channels(a2),a1
	add.l d0,a1
	asr.l #1,d1
	bpl.s .pos
	neg.l d1
.pos
	cmp.l #32767,d1
	bcs.s .large
	move.w #32767,d1
.large
	move.l ch_set_current(a1),a0
	move.w d1,set_volume(a0)

	btst #AHISB_IMM,d3
	beq.s .noimm

	move.l p_Base(a2),a0
	mulu #STREAM_OFFSET,d2
	add.l d2,a0
	move.w d1,STREAM_START+UAESNDSetCurrent+set_volume(a0)

.noimm
	movem.l (sp)+,d2/a2
	moveq #0,d0

	IFD DEBUG=1
	bsr debugreturn
	ENDC

	rts

	IFD DEBUG=1
debug_setfreq
	dc.b "SetFreq(%u,%x,%p,%x)\n",0
	even
	ENDC

	; UWORD channel D0
	; ULONG freq D1
	; struct AHIAudioCtrlDrv* A2
	; ULONG Flags D2

AHIsub_SetFreq
	movem.l d3/a2,-(sp)

	IFD DEBUG=1
	lea DEBUG_ADDR,a0
	move.w d0,(a0)
	move.l d1,(a0)
	move.l d2,(a0)
	move.l d2,(a0)
	move.l #debug_setfreq,4(a0)
	ENDC

	move.l ahiac_DriverData(a2),a2

	move.w d0,d3
	mulu #channel_SIZEOF,d0
	move.l p_Channels(a2),a1
	add.l d0,a1
	asl.l #8,d1

	move.l ch_set_current(a1),a0
	move.l d1,set_frequency(a0)

	btst #AHISB_IMM,d2
	beq.s .noimm

	move.l p_Base(a2),a0
	mulu #STREAM_OFFSET,d3
	add.l d3,a0
	move.l d1,STREAM_START+UAESNDSetCurrent+set_frequency(a0)

.noimm
	movem.l (sp)+,d3/a2
	moveq #0,d0

	IFD DEBUG=1
	bsr debugreturn
	ENDC

	rts
	
	IFD DEBUG=1
debug_setsound
	dc.b "SetSound(%u,%u,%x,%d,%p,%x)\n",0
	even
	ENDC
	
	; UWORD channel D0
	; UWORD sound D1
	; ULONG offset D2
	; LONG length D3
	; struct AHIAudioCtrlDrv* A2
	; ULONG Flags D4
	
AHIsub_SetSound
	movem.l d2-d5/a2-a5,-(sp)

	IFD DEBUG=1
	lea DEBUG_ADDR,a0
	move.w d0,(a0)
	move.w d1,(a0)
	move.l d2,(a0)
	move.l d3,(a0)
	move.l a2,(a0)
	move.l d4,(a0)
	move.l #debug_setsound,4(a0)
	ENDC

	move.l ahiac_DriverData(a2),a3

	move.w d0,d5
	mulu #channel_SIZEOF,d0
	move.l p_Channels(a3),a1
	add.l d0,a1
	move.l ch_set_current(a1),a4

	move.l p_Base(a3),a5
	add.w #STREAM_START,a5
	mulu #STREAM_OFFSET,d5
	add.l d5,a5

	cmp.w #AHI_NOSOUND,d1
	bne.s .sound_ok
	moveq #0,d2
	moveq #0,d3
	lea empty_sound(pc),a2
	bra.s .update_channel

.sound_ok
	move.w d1,d0
	mulu #sound_SIZEOF,d0
	move.l p_Sounds(a3),a2
	add.l d0,a2
	tst.l d3
	bne.s .length_ok
	move.l so_Length(a2),d3
.length_ok

.update_channel

	move.b so_Type+0(a2),set_channels(a4)
	move.b so_Type+1(a2),set_type(a4)
	moveq #0,d0
	move.w so_Samplesize(a2),d0
	move.w d0,set_sample_size(a4)
	mulu.l d0,d2
	move.l d2,set_offset(a4)
	move.l so_Address(a2),d0
	move.l d0,set_repeat_pointer(a4)
	add.l  d2,d0
	move.l d0,set_pointer(a4)
	move.l d3,set_length(a4)
	move.w #-1,set_repeat_count(a4)
	move.b #3,set_mask(a4)
	move.l a4,set_next_pointer(a4)

	bset #0,stream_master_intena(a5)

	btst #AHISB_IMM,d4
	bne.s .doimm

	; tell the sound hardware that next set is ready
	; to play when previous one has finished (or has
	; already started looping)

	move.b #1,stream_status(a5)
	bra.s .noimm

.doimm

	; start stream immediately
	move.l a4,stream_sample_pointer_imm(a5)

.noimm

	movem.l (sp)+,d2-d5/a2-a5
	moveq #0,d0

	IFD DEBUG=1
	bsr debugreturn
	ENDC

	rts

empty_sound
	dc.l 0,0
	dc.w 0,0

	IFD DEBUG=1
debug_seteffect
	dc.b "SetEffect(%p,%p)\n",0
	even
	ENDC

	; Effect* A0
	; struct AHIAudioCtrlDrv* A2

AHIsub_SetEffect
	move.l a3,-(sp)

	IFD DEBUG=1
	lea DEBUG_ADDR,a1
	move.l a0,(a1)
	move.l a2,(a1)
	move.l #debug_seteffect,4(a1)
	ENDC

	moveq #AHIE_OK,d1
	move.l ahiac_DriverData(a2),a3
	move.l ahie_Effect(a0),d0
	cmp.l #AHIET_MASTERVOLUME,d0
	bne.s .nmastervolume
	nop
	bra.s .end	
.nmastervolume
	cmp.l #AHIET_CANCEL|AHIET_MASTERVOLUME,d0
	bne.s .nmastervolume_off
	nop
	bra.s .end
.nmastervolume_off
	cmp.l #AHIET_CHANNELINFO,d0
	bne.s .nchannelinfo
	move.l a0,p_ChannelInfo(a3)
	bra.s .end
.nchannelinfo
	cmp.l #AHIET_CANCEL|AHIET_CHANNELINFO,d0
	bne.s .nchannelinfo_off
	clr.l p_ChannelInfo(a3)
	bra.s .end
.nchannelinfo_off
	moveq	#AHIE_UNKNOWN,d1
.end
	move.l (sp)+,a3
	move.l d1,d0

	IFD DEBUG=1
	bsr debugreturn
	ENDC

	rts

update_playerfunc

	movem.l a2/a3,-(sp)
	move.l a0,a3
	move.l ahiac_DriverData(a3),a2
	move.l p_Base(a2),a0
	move.l ahiac_PlayerFreq(a3),d0
	cmp.l #$10000,d0
	bcs.s .notfixed
	lsr.l #8,d0
.notfixed
	bset.b #4,STREAM_START+stream_master_intena(a0)
	move.l d0,STREAM_START+stream_timer1_frequency(a0)
	movem.l (sp)+,a2/a3
	rts

	; ULONG Flags D0
	; struct AHIAudioCtrlDrv* A2

AHIsub_Update
	
	move.l a3,-(sp)

	move.l ahiac_DriverData(a2),a3
	move.l p_Base(a3),a0
	bsr.w uaesnd_disable
	
	move.l a2,a0
	bsr.w update_playerfunc

	move.l p_Base(a3),a0
	bsr.w uaesnd_enable
	
	move.l (sp)+,a3
	rts

	IFD DEBUG=1
debug_loadsound
	dc.b "LoadSound(%u,%x,%p,%p)\n",0
	even
	ENDC
	
	; UWORD Sound D0
	; ULONG Type D1
	; APTR Info A0
	; struct AHIAudioCtrlDrv* A2

AHIsub_LoadSound
	movem.l d2/d5/a2/a3,-(sp)
	
	IFD DEBUG=1
	lea DEBUG_ADDR,a1
	move.w d0,(a1)
	move.l d1,(a1)
	move.l a0,(a1)
	move.l a2,(a1)
	move.l #debug_loadsound,4(a1)
	ENDC

	move.l ahiac_DriverData(a2),a3

	move.l p_Sounds(a3),a2
	mulu #sound_SIZEOF,d0
	add.l d0,a2
	
	moveq #AHIE_BADSOUNDTYPE,d5
	cmp.w #AHIST_SAMPLE,d1
	beq.s .sample
	cmp.w #AHIST_DYNAMICSAMPLE,d1
	bne.s .exit
.sample
	moveq #AHIE_BADSAMPLETYPE,d5
	move.l ahisi_Type(a0),d0
	lea sampletypes(pc),a1
	moveq #-1,d1
.next
	move.l (a1),d2
	cmp.l d2,d1
	beq.s .exit
	cmp.l d2,d0
	beq.s .samplefound
	addq.l #4+2+2,a1
	bra.s .next
.samplefound

	move.w 4(a1),so_Type(a2)
	move.w 6(a1),so_Samplesize(a2)
	move.l ahisi_Address(a0),so_Address(a2)
	move.l ahisi_Length(a0),so_Length(a2)
	moveq #AHIE_OK,d5
.exit
	move.l d5,d0

	IFD DEBUG=1
	bsr debugreturn
	ENDC

	movem.l (sp)+,d2/d5/a2/a3
	rts

	IFD DEBUG=1
debug_unloadsound
	dc.b "UnloadSound(%u,%p)\n",0
	even
	ENDC

	; UWORD Sound D0
	; struct AHIAudioCtrlDrv* A2

AHIsub_UnloadSound
	
	IFD DEBUG=1
	lea DEBUG_ADDR,a0
	move.w d0,(a0)
	move.l a2,(a0)
	move.l #debug_unloadsound,4(a0)
	ENDC

	move.l ahiac_DriverData(a2),a0
	move.l p_Sounds(a0),a0
	mulu #sound_SIZEOF,d0
	add.l d0,a0
	clr.w so_Type(a0)
	moveq #0,d0

	IFD DEBUG=1
	bsr debugreturn
	ENDC

	rts

sampletypes
	dc.l AHIST_M8S
	dc.b 1, 0, 0, 1
	dc.l AHIST_S8S
	dc.b 2, 0, 0, 2
	dc.l AHIST_M16S
	dc.b 1, 1, 0, 2
	dc.l AHIST_S16S
	dc.b 2, 1, 0, 4
	dc.l AHIST_M32S
	dc.b 1, 3, 0, 4
	dc.l AHIST_S32S
	dc.b 2, 3, 0, 8
	dc.l AHIST_L7_1
	dc.b 8, 3, 0, 32
	dc.l -1

uaesnd_enable
	move.l base_stream_enable(a0),base_stream_intena(a0)
	rts

uaesnd_disable
	clr.l base_stream_intena(a0)
	rts

	; struct AHIAudioCtrlDrv* A2

AHIsub_Disable
	move.l ahiac_DriverData(a2),a0
	addq.w #1,p_DisableCount(a0)
	move.l p_Base(a0),a0
	bsr uaesnd_disable
	rts

	; struct AHIAudioCtrlDrv* A2

AHIsub_Enable
	move.l ahiac_DriverData(a2),a0
	subq.w	#1,p_DisableCount(a0)
	bne.s .exit
	move.l p_Base(a0),a0
	bsr uaesnd_enable
.exit
	rts

reset_ch
	move.l p_ChannelSize(a0),d0
	beq.s .res0
	move.l p_Channels(a0),a0
	moveq #channel_SIZEOF,d1
.res1
	clr.l ch_UAESNDSet1+set_next_pointer(a0)
	sub.l d1,d0
	add.l d1,a0
	bne.s .res1
.res0
	rts

reset_hw
	clr.l base_stream_intena(a0)
	clr.l base_stream_enable(a0)
	clr.l STREAM_START+stream_timer1_frequency(a0)
	rts

	IFD DEBUG=1
debug_start
	dc.b "Start(%x,%p)\n",0
	even
	ENDC
	
	; ULONG Flags D0
	; struct AHIAudioCtrlDrv* A2

AHIsub_Start

	IFD DEBUG=1
	lea DEBUG_ADDR,a0
	move.l d0,(a0)
	move.l a2,(a0)
	move.l #debug_start,4(a0)
	ENDC

	move.l ahiac_DriverData(a2),a1
	move.l p_Base(a1),a0
	bsr reset_hw

	move.l a2,a0
	bsr.w update_playerfunc

	move.l ahiac_DriverData(a2),a1
	move.l p_Base(a1),a0
	moveq #1,d0
	move.b base_max_streams(a0),d1
	lsl.l d1,d0
	subq.l #1,d0
	move.l d0,base_stream_enable(a0)
	move.l d0,base_stream_intena(a0)
	moveq #AHIE_OK,d0

	IFD DEBUG=1
	bsr debugreturn
	ENDC

	rts	

	IFD DEBUG=1
debug_stop
	dc.b "Stop(%x,%p)\n",0
	even
	ENDC

	; ULONG Flags D0
	; struct AHIAudioCtrlDrv* A2

AHIsub_Stop:

	IFD DEBUG=1
	lea DEBUG_ADDR,a0
	move.l d0,(a0)
	move.l a2,(a0)
	move.l #debug_stop,4(a0)
	ENDC

	move.l ahiac_DriverData(a2),a0
	move.l p_Base(a0),a0
	bsr reset_hw

	move.l ahiac_DriverData(a2),a0
	bsr.w reset_ch

	moveq #AHIE_OK,d0
	rts

	IFD DEBUG=1
debug_allocaudio
	dc.b "AllocAudio(%p,%p)\n",0
	even
	ENDC

	; struct TagItem* A1
	; struct AHIAudioCtrlDrv* a2

AHIsub_AllocAudio
	movem.l d2-d3/d7/a3-a6,-(sp)

	IFD DEBUG=1
	lea DEBUG_ADDR,a0
	move.l a1,(a0)
	move.l a2,(a0)
	move.l #debug_allocaudio,4(a0)
	ENDC

	moveq #AHISF_ERROR,d7
	
	move.l a6,a5
	move.l a1,d3

	move.l ub_SysLib(a5),a6

	move.l #UAESND_SIZEOF,d0
	move.l #MEMF_PUBLIC|MEMF_CLEAR,d1
	call AllocMem
	move.l d0,ahiac_DriverData(a2)
	beq .error
	move.l d0,a3

	move.l a5,p_UAESNDBase(a3)
	move.l ub_Base(a5),a4
	moveq #0,d0
	move.b base_max_streams(a4),d0
	move.w d0,p_StreamCnt(a3)
	move.l a4,p_Base(a3)
	move.l a2,p_AudioCtrl(a3)
	
	moveq #0,d0
	move.b base_max_streams(a4),d0
	cmp.w ahiac_Channels(a2),d0
	bcs .error

	mulu #channel_SIZEOF,d0
	move.l d0,p_ChannelSize(a3)
	move.l #MEMF_PUBLIC|MEMF_CLEAR,d1
	call AllocMem
	move.l d0,p_Channels(a3)
	beq	.error

	move.l d0,a1
	move.w ahiac_Channels(a2),d1
	subq.w #1,d1
.setch
	lea ch_UAESNDSet1(a1),a0
	move.l a0,ch_set_current(a1)
	add.w #channel_SIZEOF,a1
	dbf d1,.setch

	move.w ahiac_Sounds(a2),d0
	mulu.w #sound_SIZEOF,d0
	move.l d0,p_SoundSize(a3)
	move.l #MEMF_PUBLIC|MEMF_CLEAR,d1
	call AllocMem
	move.l d0,p_Sounds(a3)
	beq	.error

	move.l a3,a0
	bsr.w reset_ch

	move.l a4,a0
	bsr.w reset_hw

	lea p_Interrupt(a3),a1
	lea interrupt_code(pc),a0
	move.l a0,IS_CODE(a1)
	lea intname(pc),a0
	move.l a0,LN_NAME(a1)
	move.b #NT_INTERRUPT,LN_TYPE(a1)
	move.b #40,LN_PRI(a1)
	move.l a3,IS_DATA(a1)
	moveq #INTB_EXTER,d0
	call AddIntServer
	st p_intadded(a3)

	move.l a4,a0
	moveq #1,d0
	move.w p_StreamCnt(a3),d1
	lsl.l d1,d0
	subq.l #1,d0
	move.l d0,base_stream_allocate(a0)

	move.l #AHISF_KNOWSTEREO|AHISF_KNOWHIFI|AHISF_KNOWMULTICHANNEL,d7

.error
	move.l d7,d0

	IFD DEBUG=1
	bsr debugreturn
	ENDC

	movem.l (sp)+,d2-d3/d7/a3-a6
	rts

	IFD DEBUG=1
debug_freeaudio
	dc.b "FreeAudio(%p)\n",0
	even
	ENDC

AHIsub_FreeAudio
	movem.l a3/a5/a6,-(sp)

	IFD DEBUG=1
	lea DEBUG_ADDR,a0
	move.l a2,(a0)
	move.l #debug_freeaudio,4(a0)
	ENDC

	move.l a6,a5
	move.l ub_SysLib(a5),a6
	move.l ahiac_DriverData(a2),d0
	beq.s .noaudio
	move.l d0,a3
	
	tst.b p_intadded(a3)
	beq.s .noint
	lea p_Interrupt(a3),a1
	moveq #INTB_EXTER,d0
	call RemIntServer	

	move.l p_Base(a3),a0
	bsr.w reset_hw
	clr.l base_stream_allocate(a0)
.noint
	
	move.l p_Sounds(a3),d0
	beq.s .nosounds
	move.l d0,a1
	move.l p_SoundSize(a3),d0
	call FreeMem
.nosounds

	move.l p_Channels(a3),d0
	beq.s .nochannels
	move.l d0,a1
	move.l p_ChannelSize(a3),d0
	call FreeMem
.nochannels
	
	move.l a3,a1
	move.l p_DriverDataSize(a3),d0
	call FreeMem

	clr.l ahiac_DriverData(a2)
	
.noaudio
	movem.l (sp)+,a3/a5/a6
	rts

	IFD DEBUG=1
debug_getattr
	dc.b "GetAttr(%x,%x,%x,%p,%p)\n",0
	even
	ENDC

	; ULONG Attribute D0
	; LONG Argument D1
	; LONG DefValue D2
	; struct TagItem* A1
	; struct AHIAudioCtrlDrv* A2

AHIsub_GetAttr
	move.l d2,-(sp)

	IFD DEBUG=1
	lea DEBUG_ADDR,a0
	move.l d0,(a0)
	move.l d1,(a0)
	move.l d2,(a0)
	move.l a1,(a0)
	move.l a2,(a0)
	move.l #debug_getattr,4(a0)
	ENDC

	cmp.l #AHIDB_Frequency,d0
	bne.s .notfreq
	lea tag_frequencies(pc),a0
	move.l 0(a0,d1.w*4),d2
	bra.s .exit
.notfreq
	cmp.l #AHIDB_Index,d0
	bne.s .notindex
	lea tag_frequencies(pc),a0
	moveq #0,d2
.freqnext
	tst.l (a0)
	beq.s .freqexit
	cmp.l (a0)+,d1
	bls.s .exit
	addq.l #1,d2
	bra.s .freqnext
.freqexit
	moveq #FREQUENCIES-1,d2
	bra.s .exit
.notindex
	lea GetAttrTags(pc),a0
.next
	tst.l (a0)
	beq.s .exit
	cmp.l (a0),d0
	addq.l #4+4,a0
	bne.s .next
	move.l -4(a0),d2
.exit
	move.l d2,d0
	
	IFD DEBUG=1
	bsr debugreturn
	ENDC
	
	move.l (sp)+,d2
	rts

tag_frequencies
	dc.l 4410	; CD/10
	dc.l 4800	; DAT/10
	dc.l 5513	; CD/8
	dc.l 6000	; DAT/8
	dc.l 7350	; CD/6
	dc.l 8000	; µ- and A-Law, DAT/6
	dc.l 9600	; DAT/5
	dc.l 11025	; CD/4
	dc.l 12000	; DAT/4
	dc.l 14700	; CD/3
	dc.l 16000	; DAT/3
	dc.l 17640	; CD/2.5
	dc.l 18900
	dc.l 19200	; DAT/2.5
	dc.l 22050	; CD/2
	dc.l 24000	; DAT/2
	dc.l 27429
	dc.l 29400	; CD/1.5
	dc.l 32000	; DAT/1.5
	dc.l 33075
	dc.l 37800
	dc.l 44100	; CD
	dc.l 48000	; DAT
	dc.l 56000
	dc.l 96000
FREQUENCIES EQU (*-tag_frequencies)>>2	
tag_frequencies_end
	dc.l 0

GetAttrTags
	dc.l AHIDB_Bits, 32
	dc.l AHIDB_Frequencies, FREQUENCIES
	dc.l AHIDB_MaxChannels, 8
	dc.l AHIDB_Author, tag_author
	dc.l AHIDB_Copyright, tag_copyright
	dc.l AHIDB_Version, IDString
	dc.l AHIDB_Record, 0
	dc.l AHIDB_Outputs, 1
	dc.l AHIDB_Output, tag_output
	dc.l AHIDB_PingPong, 1
	dc.l AHIDB_Realtime, 1
	dc.l AHIDB_MinOutputVolume, 0
	dc.l AHIDB_MaxOutputVolume, $10000
	dc.l 0

tag_author
	dc.b "Toni Wilen",0
tag_copyright
	dc.b "© 2020 Toni Wilen",0
tag_output
	dc.b "UAE",0
	even

	IFD DEBUG=1
debug_hardwarecontrol
	dc.b "HardwareControl(%x,%x,%p)\n",0
	even
	ENDC

	; ULONG Attribute D0
	; LONG Argument D1
	; struct AHIAudioCtrlDrv* A2

AHIsub_HardwareControl

	IFD DEBUG=1
	lea DEBUG_ADDR,a0
	move.l d0,(a0)
	move.l d1,(a0)
	move.l a2,(a0)
	move.l #debug_hardwarecontrol,4(a0)
	ENDC

	move.l ahiac_DriverData(a2),a0
	move.l p_Base(a0),a0

	cmp.l #AHIC_MonitorVolume,d0
	bne.s .dontsetmonvol
	nop
	bra.s .done
.dontsetmonvol
	cmp.l #AHIC_MonitorVolume_Query,d0
	bne.s .dontgetmonvol
	moveq #1,d0
	swap d0
	bra.s .doneout
.dontgetmonvol
	cmp.l #AHIC_OutputVolume,d0
	bne.s .dontsetoutvol
	lsr.l #1,d1
	nop
	bra.s .done
.dontsetoutvol
	cmp.l #AHIC_OutputVolume_Query,d0
	bne.s .dontgetoutvol
	
	moveq #1,d0
	swap d0
	bra.s .doneout
.dontgetoutvol
	cmp.l #AHIC_InputGain,d0
	bne.s .dontsetinputgain
	nop
	bra.s .done
.dontsetinputgain
	cmp.l #AHIC_InputGain_Query,d0
	bne.s .dontgetinputgain
	moveq #1,d0
	swap d0
	bra.s .doneout
.dontgetinputgain
	cmp.l #AHIC_Input,d0
	bne.s .dontsetinput
	nop
	bra.s .done
.dontsetinput
	cmp.l #AHIC_Input_Query,d0
	bne.b .dontgetinput
	moveq #0,d0
	bra.s .doneout
.dontgetinput
	cmp.l #AHIC_Output,d0
	bne.s .dontsetoutput
	nop
	bra.s .done
.dontsetoutput
	cmp.l #AHIC_Output_Query,d0
	bne.b .dontgetoutput
	moveq #0,d0
	bra.s .doneout
.dontgetoutput
	moveq #0,d0
	bra.s .doneout
.done
	moveq #1,d0
.doneout
	rts

	; d0.w = channel
	; a0 = AHIAudioCtrlDrv
callsoundfunc:
	movem.l a2/a6,-(sp)
	move.l a0,a2
	move.l ahiac_SoundFunc(a2),d1
	beq.s .nosoundfunc
	move.l d1,a0
	move.l ahiac_DriverData(a2),a1
	move.l p_Channels(a1),a1
	move.w d0,d1
	mulu #channel_SIZEOF,d1
	add.l d1,a1
	add.w #ch_SndMsg,a1
	move.w d0,(a1)
	ext.l d0
	move.l h_Entry(a0),a6
	jsr	(a6)
.nosoundfunc
	movem.l (sp)+,a2/a6
	rts

	; a1 = UAESND
interrupt_code
	move.l p_Base(a1),a0
	move.l base_stream_intreq(a0),d0
	beq.s .notours

	movem.l d2-d7/a2-a4,-(sp)
	move.l d0,d7
	move.l a1,a5
	move.l p_AudioCtrl(a5),a2
	move.l ahiac_DriverData(a2),a3
	lea STREAM_START(a0),a4

	moveq #0,d6
.cont
	btst d6,d7
	beq.s .next

	; read and clear interrupt status
	move.b stream_intreq(a4),d2
	bpl.s .next
	btst #4,d2
	beq.s .notimer

	move.l p_ChannelInfo(a3),d0
	beq.s .noci
	move.l d0,a0
	lea	ahieci_Offset(a0),a1
	move.w ahieci_Channels(a0),d0
	subq.w #1,d0
	bmi.s .noci
	move.l p_Channels(a3),a6
	move.l a4,a0
.loop
	move.l set_length_original(a0),d1
	sub.l set_length(a0),d1
	move.l d1,(a1)+
	add.w #STREAM_OFFSET,a0
	dbf d0,.loop
	
	move.l p_ChannelInfo(a3),a1
	move.l ahieci_Func(a1),d0
	beq.s .noci
	move.l d0,a0
	move.l h_Entry(a0),a6
	jsr	(a6)
.noci

	; playerfunc
	move.l ahiac_PlayerFunc(a2),d0
	beq.s .noplayerfunc
	move.l d0,a0
	sub.l a1,a1
	move.l h_Entry(a0),a6
	jsr (a6)
.noplayerfunc
	
.notimer

	; sample started interrupt?
	btst #0,d2
	beq.s .next
	
	; soundfunc
	move.w d6,d0
	move.l a2,a0
	bsr.w callsoundfunc

.next
	add.w #STREAM_OFFSET,a4
	addq.w #1,d6
	cmp.w p_StreamCnt(a3),d6
	bne.s .cont
	
	movem.l (sp)+,d2-d7/a2-a4
	moveq #0,d0
	rts
.notours
	moveq #1,d0
	rts

initRoutine:
	movem.l	d1/a0/a1/a4/a5/a6,-(sp)
	sub.l a4,a4
	move.l d0,a5
	move.l a6,ub_SysLib(a5)
	move.l a0,ub_SegList(a5)

	lea utilname(pc),a1
	moveq #0,d0
	call OpenLibrary
	move.l d0,ub_UtilBase(a5)
	beq.s .end

	lea expname(pc),a1
	moveq #0,d0
	call OpenLibrary
	tst.l d0
	beq.s .end
	move.l d0,a6
	sub.l a0,a0
	move.w #6502,d0
	moveq #2,d1
	jsr -$048(a6) ; FindConfigDev
	move.l d0,ub_ConfigDev(a5)
	move.l a6,a1
	move.l ub_SysLib(a5),a6
	call CloseLibrary

	move.l ub_ConfigDev(a5),d0
	beq.s .end
	move.l d0,a0
	move.l cd_BoardAddr(a0),ub_Base(a5)

	move.l a5,a4
.end
	move.l a4,d0
	movem.l	(sp)+,d1/a0/a1/a4/a5/a6
	rts

Open:
	addq.w #1,LIB_OPENCNT(a6)
	bclr.b #LIBB_DELEXP,ub_Flags(a6)
	move.l a6,d0
	rts

Close:
	moveq #0,d0
	subq.w #1,LIB_OPENCNT(a6)
	bne.b .exit
	btst.b #LIBB_DELEXP,ub_Flags(a6)
	beq.b .exit
	bsr	Expunge
.exit
	rts

Expunge:
	movem.l	d1/d2/a0/a1/a5/a6,-(sp)
	move.l a6,a5
	move.l ub_SysLib(a5),a6
	tst.w LIB_OPENCNT(a5)
	beq.b .notopen
	bset.b #LIBB_DELEXP,ub_Flags(a5)
	moveq #0,d0
	bra.b .Expunge_end
.notopen:

	move.l a5,a1
	call Remove

	move.l ub_UtilBase(a5),d0
	beq.s .noutil
	move.l d0,a1
	call CloseLibrary
.noutil

	move.l ub_SegList(a5),d2
	moveq #0,d0
	move.l a5,a1
	move.w LIB_NEGSIZE(a5),d0
	sub.l d0,a1
	add.w LIB_POSSIZE(a5),d0
	call FreeMem

	move.l d2,d0
.Expunge_end
	movem.l	(sp)+,d1/d2/a0/a1/a5/a6
	rts

Null:
	moveq #0,d0
	rts

expname
	dc.b "expansion.library",0
utilname
	dc.b "utility.library",0
intname
	dc.b "uaesnd_ahi",0
	cnop 0,4

EndCode: