supermario/base/SuperMarioProj.1994-02-09/OS/ADBMgr/ADBMgrPatch.a
2019-06-29 23:17:50 +08:00

1289 lines
47 KiB
Plaintext
Raw Permalink Blame History

This file contains ambiguous Unicode characters

This file contains Unicode characters that might be confused with other characters. If you think that this is intentional, you can safely ignore this warning. Use the Escape button to reveal them.

;
; File: ADBMgrPatch.a
;
; Contains: Patches Gary Davidian's new ADB manager into MacII's and MacSE's
;
; Written by: Gary Davidian/Gary Rensberger
;
; Copyright: © 1989-1993 by Apple Computer, Inc., all rights reserved.
;
; Change History (most recent first):
;
; <SM2> 11/9/93 KW added some eieioSTP macros. Only active for CygnusX1 ROM
; <13> 2/12/92 JSM Moved this file to ADBMgr folder, keeping all the old revisions.
; <12> 10/4/91 JSM Change PsychoticFarmerOrLater conditionals to TheFuture.
; <11> 9/22/91 DTY Change PsychoticFarmerAndLater to PsychoticFarmerOrLater.
; <10> 8/29/91 JSM Cleanup header.
; <9> 8/27/91 DTY Conditionalized previous change for PsychoticFarmerAndLater.
; <8> 7/16/91 GMR Fixed bug when ADB explicit command is going out just as
; autopoll data is being received (occurs very seldom).
; <7> 6/12/91 LN added #include 'InternalOnlyEqu.a'
; <6> 8/10/90 DTY Addded notAUX conditional to patches.
; <5> 8/7/90 DTY Convert to a linked patch.
; <4> 7/11/90 gbm Change HardwareEqu.a to HardwarePrivateEqu.a
; <3> 4/26/90 GMR Now sets the mouse and keyboard bits in the DevMap by default
; during patch installation since the old ADB manager didn't use
; these and weren't set up.
; <2> 3/6/90 GMR Fixed initing of FDBFlag, to set command queue empty bit.
; <1.2> 11/29/89 GGD NEEDED FOR 6.0.5: Forced the interrupt masking level to 7 to
; work correctly on all machines, instead of using HiIntMask which
; is level 3 by default in HardwareEqu. Deleted the initialization
; of TimeViaDB, since it was always using the MacII value (and was
; wrong for the SE), It is now initialized correctly in Rom78Fix
; and Rom76Fix. Changed the Auto/SRQ polling to only poll devices
; that are in the device table.
; <1.1> 10/14/89 GMR Modified ADBProc to save/restore keyboard and mouse CRA's
; (around _ADBReinit trap). Added KbdInstall to patch, instead of
; using ROM version. Installation code does not re-init the ADB
; bus, preserving original device entry table.
; <1.0> 10/3/89 GMR Adding for first time to EASE
;
PRINT OFF
PrNonPortable EQU 1
Debugging EQU 0
INCLUDE 'SysEqu.a'
INCLUDE 'ToolEqu.a'
INCLUDE 'SysErr.a'
INCLUDE 'Private.a'
INCLUDE 'QuickEqu.a'
INCLUDE 'Traps.a'
INCLUDE 'HardwarePrivateEqu.a'
INCLUDE 'ApplDeskBus.a'
INCLUDE 'AppleDeskBusPriv.a'
INCLUDE 'LinkedPatchMacros.a'
INCLUDE 'InternalOnlyEqu.a'
jADBReInit EQU OSTable+($7B*4) ; OS trap table entry for _ADBReInit
NoIntMask EQU $0700 ; all ints disabled on all machines <1.2>
PRINT ON
GEmptyAddr ROMBind (SE,$03574),(II,$06FEE)
KbdDrvr ROMBind (SE,$03AC0),(II,$0753A)
ROMInitADBDrvr ROMBind (SE,$03C9E),(II,$07724)
FindFDBInfo ROMBind (SE,$03D4C),(II,$077D2)
;______________________________________________________________________
;
; _ADBReInit - ReInitialize the Front Desk Bus
;
;______________________________________________________________________
ADBReinit PatchProc _ADBReInit,(SE,II,notAUX)
IMPORT ReInit
MOVE.L JADBProc,A0 ; get hook to processing routine <C931>
moveq.l #0,D0 ; set it as pre-processing routine <C931>
JSR (A0) ; call the routine <C931>
MoveM.L D0-D4/A0-A3,-(SP)
Move.L ADBBase,A3 ; A3 get local data address
BSR ReInit
IADB1 jsrROM ROMInitADBDrvr
MoveM.L (SP)+,D0-D4/A0-A3 ; restore registers
Move.L JADBProc,A0 ; get hook to processing routine <C931>
MoveQ #1,D0 ; set it as post-processing routine. <C931>
JSR (A0) ; call the routine <C931>
RTS ; done <C931>
ENDPROC
;_______________________________________________________________________
;
; Routine: _ADBOp
; Inputs: A0.L - pointer to ADBOpBlock paramater block
; D0.B - ADB command/address byte to send
;
; Outputs: D0 - Result Code (noErr, or -1 if queue full)
;
; Destroys: A0, A1, D0
; Calls: RunADBRequest
; Called by: OsTrap Dispatch Table
;
; Function: Asynchronously issues an ADB bus transaction, using the command
; and buffer specified. When the transaction has completed,
; the completion routine will be called.
;
;_______________________________________________________________________
patchADBOp PatchProc _ADBOp,(SE,II,notAUX) ; a0-a1/d1-d2 saved by OsTrap dispatch
IMPORT RunADBRequest
with ADBVars,ADBCmdQEntry
@regs reg d3/a2/a3 ; additional registers to preserve
movem.l @regs,-(sp) ; save registers
movea.l ADBBase,a3 ; point to ADB private data structures
move.w sr,-(sp) ; save interrupt mask
ori.w #NoIntMask,sr ; disable ints while queueing <1.2>
movea.l fQEntPtr(a3),a1 ; pointer to next free element
btst.b #fDBQEmpty,fDBFlag(a3) ; see if anything in queue
bne.s @notFull ; if was empty, plenty of room to add
cmpa.l fQHeadPtr(a3),a1 ; see if queue is full
beq.s @queueFull ; if full, abort with error
; There is room in the queue, so insert the new request at the end of the queue
@notFull ; a1 points to the ADBCmdQEntry
move.b d0,(a1)+ ; fill in fQCmd
addq.w #1,a1 ; skip over fQUnused
move.l (a0)+,(a1)+ ; copy dataBuffPtr to fQBuff
move.l (a0)+,(a1)+ ; copy opServiceRtPtr to fQComp
move.l (a0)+,(a1)+ ; copy opDataAreaPtr to fQData
cmpa.l fQEndPtr(a3),a1 ; see if queue pointer needs to wrap around
blo.s @noWrap ; if didn't reach end, no wrap yet
movea.l fQBegPtr(a3),a1 ; if end reached, wrap back to begining
@noWrap move.l a1,fQEntPtr(a3) ; update the queue entry pointer
; The new entry is queued. If queue was previously empty run the new request.
bclr.b #fDBQEmpty,fDBFlag(a3) ; indicate queue no longer empty
beq.s @success ; if not at head of queue, just return success
bsr RunADBRequest ; run the newly queued request
@success moveq.l #noErr,d0 ; indicate success
@done move.w (sp)+,sr ; restore int mask
movem.l (sp)+,@regs ; restore registers
rts ; all done
@queueFull moveq.l #qErr,d0 ; IM vol 5 says return -1 for queue full
bra.s @done ; restore regs and return
endwith
ENDPROC
;_______________________________________________________________________
;
; InitADB - Initialize state variables
;
;_______________________________________________________________________
InitADB InstallProc (SE,II,notAUX)
IMPORT ADBProc, FDBTask, FDBShiftInt
IMPORT StartReqVIA, MouseDrvr
IMPORT RunADBRequest, DefaultDev
with ADBVars,ADBDeviceEntry,ADBCmdQEntry
movea.l VIA,a1 ; point to the VIA1 registers
@wait
eieioSTP
move.b vBufB(a1),d0
eieioSTP
andi.b #(1<<vFDesk2)|\
(1<<vFDesk1),d0 ; look at state bits
cmpi.b #(1<<vFDesk2)|\
(1<<vFDesk1),d0 ; are we at state 3?
bne.s @wait ; no, keep waiting...
ori.w #NoIntMask,sr ; mask out interrupts <1.2>
eieioSTP
move.b vSR(a1),d0 ; empty shift reg
eieioSTP
MOVE.L ADBBase,A3 ; point to ADB private data structures
leaResident ADBProc,A0 ; Get the ADBProc
move.l A0,JADBProc ; install it into JAdbProc vector
leaResident FDBTask, A0 ; setup the FDB VBL task
move.l A0,JKybdTask ; lomem vector
leaResident FDBShiftInt,A0 ; get addr of front desk bus handler <4.6>
move.l A0,Lvl1DT+8 ; install as SR interrupt receiver
leaResident StartReqVIA,a0 ; get HW dependent proc to start ADB request
move.l a0,StartReqProc(a3) ; setup proc pointer
moveq #0,d1 ; reset device table index
@check cmpi.b #MouseAddr,FDBOAddr(a3,d1.w) ; is this a mouse device?
bne.s @next ; no, try next one
leaResident MouseDrvr,a0 ; get address of new mouse driver
move.l a0,FDBCRA(a3,d1.w) ; save as completion routine address
@next addi.b #FRecSize,d1 ; advance offset
cmpi.b #numFDBAdr*FRecSize,d1 ; are we at the end of table?
bne.s @check ; no, continue checking
moveq #(FQSize*8/4)-1,d1 ; # of long words in command queue
lea startCQ(a3),a0 ; pt to start of command queue
@clear clr.l (a0)+ ; clear out command queue
dbra d1,@clear
move.b #(1<<FDBQEmpty),\ ; the command queue is empty... <2>
FDBFlag(A3) ; initialize the flags
clr.b FDBAuFlag(A3)
Lea StartCQ(A3),A0
Move.L A0,FQBegPtr(A3) ; initialize command queue pointer
Move.L A0,FQHeadPtr(A3) ; initialize command queue pointer
Move.L A0,FQEntPtr(A3) ; initialize command queue pointer
Lea EndCQ(A3),A0
Move.L A0,FQEndPtr(A3) ; initialize command queue end pointer
ori.b #(1<<mouseAddr)|\
(1<<kbdAddr ),DevMap+1(a3) ; make sure we poll keyboard and mouse <3>
andi #$F8FF,SR ; clear Interrupt mask
bsr RunADBRequest ; start auto poll for the mouse
bsr DefaultDev ; setup mouse & keyboard as default
rts
ENDPROC
;______________________________________________________________________
; Stack frame equates for InitADBDrvr and ADBProc
ourLocals RECORD {endLocals},increment
iDeviceTy ds.b 1
iOrigAddr ds.b 1
iCRAddr ds.l 1
iDataAddr ds.l 1
endLocals
ENDR
;______________________________________________________________________
;
; ADBProc - this routine lives in the JADBProc vector and is called
; by ADBReInit before and after initialization
;
; D0 is 0 if pre-processing, non-0 if post-processing.
; In addition to the standard pascal calling conventions.
;______________________________________________________________________
ADBProc PROC EXPORT ; <1.1>
EXPORT ReInit
EXPORT FDBTask
EXPORT FDBShiftInt
EXPORT StartReqVIA
EXPORT MouseDrvr
EXPORT RunADBRequest
EXPORT DefaultDev
with ourLocals,ADBVars,ADBDeviceEntry,ADBCmdQEntry
tst.l d0 ; 0 = pre-processing
bne.s PostInit ; Skip if not
;_______________________________________________________________________
; PreInit is called after the bus is initialized. It saves
; keyboard/mouse driver ptrs, then disposes of keyboards storage.
;_______________________________________________________________________
_CountADBs ; Get the number of ADB devices
move.w d0, d2 ; Save it in D2
beq.s @exit ; Skip if none
link a6,#iDeviceTy ; Make a stack frame
@RemoveLoop
lea iDeviceTy(a6), a0 ; A0 is parameter block
move.w d2, d0
_GetIndADB ; Get a device entry
bmi.s @NextRec ; Skip if not valid
cmp.b #kbdAddr,iOrigAddr(A6) ; Keyboard?
bne.s @Mouse ; no, see if mouse
lea KbdDriver,a0
move.l iCRAddr(a6),(a0) ; save ptr to keyboard driver
bra.s @setIt
@Mouse cmp.b #MouseAddr,iOrigAddr(A6) ; Mouse?
bne.s @NextRec ; no, check next entry
lea MseDriver,a0
move.l iCRAddr(a6),(a0) ; save ptr to mouse driver
bra.s @NextRec ; next entry
@setIt MOVE.L iDataAddr(a6), A1 ; Save the data address pointer
CLR.L iDataAddr(a6) ; Clear it out, so the keyboard won't trash memory
lea iCRAddr(a6), A0
_SetADBInfo ; D0 already contains the ADB Address
move.l a1, a0 ; Get the data address pointer
_DisposPtr ; Throw away the block
@NextRec subq.w #1, D2
bgt.s @RemoveLoop
unlk A6
@exit
rts
KbdDriver DS.L 1 ; saves ptr to keyboard driver
MseDriver DS.L 1 ; saves ptr to keyboard driver
;_______________________________________________________________________
; PostInit is called after the bus is initialized. It restores
; keyboard/mouse driver ptr in device entries.
;_______________________________________________________________________
PostInit
_CountADBs ; Get the number of ADB devices
move.w D0, D2 ; Save it in D2
beq.s @exit ; Skip if none
link A6, #iDeviceTy ; Make a stack frame
@InstallLoop
lea iDeviceTy(A6), A0 ; A0 is parameter block
move.w D2, D0
_GetIndADB ; Get a device entry
bmi.s @NextRec ; Skip if not valid
cmp.b #kbdAddr,iOrigAddr(A6) ; Keyboard?
bne.s @Mouse ; no, see if mouse
move.l KbdDriver,iCRAddr(A6) ; Restore ptr to keyboard driver
bra.s @setIt
@Mouse cmp.b #MouseAddr,iOrigAddr(A6); Mouse?
bne.s @NextRec ; Skip if not
move.l MseDriver,iCRAddr(A6) ; Restore ptr to mouse driver
@setIt lea iCRAddr(A6), A0
_SetADBInfo ; D0 already contains the ADB Address
@NextRec subq.w #1, D2
bgt.s @InstallLoop
unlk A6
@exit rts
;_______________________________________________________________________
;
; ReInit - Initialize state variables, re-scan for devices
;_______________________________________________________________________
ReInit
ori.w #NoIntMask,sr ; mask out interrupts <1.2>
move.w #((endCQ/4)-1),D0 ; n entries
move.l A3,A0 ; clear out device table and command queue
@ClrLoop clr.l (A0)+
dbra D0,@ClrLoop ; clear next entry
move.b #(1<<FDBInit)|\
(1<<FDBQEmpty),FDBFlag(A3) ; initialize the flags
clr.b FDBAuFlag(A3)
lea StartCQ(A3),A0
move.l A0,FQBegPtr(A3) ; initialize command queue pointer
move.l A0,FQHeadPtr(A3) ; initialize command queue pointer
move.l A0,FQEntPtr(A3) ; initialize command queue pointer
lea EndCQ(A3),A0
move.l A0,FQEndPtr(A3) ; initialize command queue end pointer
bsr InitDevT ; go initialize the device table
andi #$F8FF,SR ; clear Interrupt mask
@wait btst #FDBInit,FDBFlag(A3); done with initialization?
bne.s @wait ; no, keep in loop
jsr DefaultDev ; setup mouse & keyboard as default
jsr KbdInstall ; Install keyboard information
rts
endwith
;______________________________________________________________________
;
; DefaultDev - check mouse and keyboard in the device table, if they
; are not there, set them up as default device anyway.
;
;______________________________________________________________________
DefaultDev
with ADBVars,ADBDeviceEntry ; <1.9>
MoveQ #kbdAddr,D0 ; first check keyboard
FFI2 jsrROM FindFDBInfo ; look for keyboard (FindFDBInfo)
TST.B D0 ; is it there?
BEQ.S ChkMouse ; branch, keyboard is there
Move.B #1,FDBDevTy(A1) ; assume handleID 1
Move.B #kbdAddr,FDBOAddr(A1) ; set original address as 2
Move.B #kbdAddr,FDBAddr(A1) ; set FDB address as 2
KD1 leaROM KbdDrvr,A0
move.l a0,FDBCRA(A1) ; stuff completion routine address
bset.b #kbdAddr,DevMap+1(a3) ; remember to poll it <1.9>
ChkMouse
MoveQ #mouseAddr,D0 ; now check mouse
FFI3 jsrROM FindFDBInfo ; look for mouse (FindFDBInfo)
BEQ.S DefExit ; branch, mouse is there
Move.B #1,FDBDevTy(A1) ; assume handleID 1
Move.B #mouseAddr,FDBOAddr(A1) ; set original address as 3
Move.B #mouseAddr,FDBAddr(A1) ; set FDB address as 3
Lea MouseDrvr,A0 ; get mouse address
Move.L A0,FDBCRA(A1) ; set completion routine address
bset.b #mouseAddr,DevMap+1(a3) ; remember to poll it <1.9>
DefExit
RTS ; done
endwith
Title 'KbdADB - ADB Manager - RunADBRequest'
;_______________________________________________________________________
;
; Routine: RunADBRequest
; Inputs: A3 - pointer to ADBBase
;
; Outputs: D2 - length of transmit buffer data
; D3 - command byte / implicit flag (bit 31)
; A2 - pointer to buffer containing transmit data
; A3 - pointer to ADBBase
;
; Destroys:
; Calls: exits through StartReqProc (hardware dependent)
;
; Function: Determines what command should be sent to ADB next, and calls
; the hardware dependent routine to process the next request.
;
;_______________________________________________________________________
RunADBRequest
with ADBVars,ADBCmdQEntry
btst.b #fDBQEmpty,fDBFlag(a3) ; see if any explicit commands to run
beq.s @runFromQueue ; run an explicit command from the queue
moveq.l #0,d2 ; zero the send byte count
moveq.l #-1,d3 ; negative command to indicate resume polling
btst.b #FDBInit,fDBFlag(a3); are we still initializing the bus
beq.s @resumePolling ; if not, resume auto command polling
rts ; still initializing, just return
@runFromQueue
movea.l fQHeadPtr(a3),a0 ; get pointer to element at head
moveq.l #0,d3 ; zero extend command byte, indicate explicit cmd
move.b fQCmd(a0),d3 ; D3 := command byte
movea.l fQBuff(a0),a2 ; get the buffer address (pascal string)
moveq.l #maskADBCmd,d2 ; mask talk/listen command bits
and.b d3,d2 ; isolate bits from copy of command
subq.b #ListenCmd,d2 ; see if it is a listen command
seq.b d2 ; $00FF if listen, $0000 if not (only listen sends data)
and.b (a2)+,d2 ; D2 := byte count, A2 := ptr to actual data
@resumePolling
movea.l StartReqProc(a3),a0 ; get HW dependent proc to start ADB request
jmp (a0) ; start the ADB request
endwith
Title 'KbdADB - ADB Manager - ExplicitRequestDone'
;_______________________________________________________________________
;
; Routine: ExplicitRequestDone
; Inputs: D2 - length of receive buffer data
; D3 - command byte / SRQ flag (bit 31)
; A2 - pointer to buffer containing receive data
; A3 - pointer to ADBBase
;
; Outputs: D2 - length of receive buffer data
; D3 - command byte / SRQ flag (bit 31)
; A0 - pointer to buffer to pass to completion routine
; A2 - pointer to buffer containing receive data
; A3 - pointer to ADBBase
; 0(SP) - completion routine address
; 4(SP) - optional data to pass in A2 to completion routine
; 8(SP) - stack cutback address, after completion routine runs
;
; Destroys: D0, D1, A0, A1
; Calls: exits through RequestDone
;
; Function: Dequeues the paramaters to pass to the service routine.
;
;_______________________________________________________________________
ExplicitRequestDone
with ADBVars,ADBCmdQEntry
move.l sp,-(sp) ; allocate an empty buffer on the stack
move.w sr,d1 ; save interrupt mask
ori.w #NoIntMask,sr ; disable ints while dequeueing <1.2>
movea.l fQHeadPtr(a3),a0 ; get pointer to element to dequeue
if Debugging then
btst.b #fDBQEmpty,fDBFlag(a3) ; see if anything in queue
beq.s @hasEntries ; if something to dequeue, we're ok
_Debugger ; if not, we're dead
@hasEntries cmp.b (a0),d3 ; check command sent against command received
beq.s @cmdOK ; if match, we're ok
_Debugger ; if not, we're dead
@cmdOK
endif
adda.w #fQSize,a0 ; point past end of element
movea.l a0,a1 ; save pointer to end of queue element
cmpa.l fQEndPtr(a3),a0 ; see if queue pointer needs to wrap around
blo.s @noWrap ; if didn't reach end, no wrap yet
movea.l fQBegPtr(a3),a0 ; if end reached, wrap back to begining
@noWrap move.l a0,fQHeadPtr(a3) ; update the queue head pointer
cmpa.l fQEntPtr(a3),a0 ; see if queue is now empty
bne.s @notEmpty ; if not, don't need to change empty flag
bset.b #fDBQEmpty,fDBFlag(a3) ; queue is now empty, set flag to remember it
@notEmpty
move.l -(a1),-(sp) ; copy fQData to A2 save area on stack
move.l -(a1),-(sp) ; copy fQComp to A1 save area on stack
movea.l -(a1),a0 ; copy fQBuff to A0
move.w d1,sr ; restore interrupt mask
bra.s RequestDone ; copy buffer data, resume ADB, call handler
endwith
Title 'KbdADB - ADB Manager - ImplicitRequestDone'
;_______________________________________________________________________
;
; Routine: ImplicitRequestDone
; Inputs: D2 - length of receive buffer data
; D3 - command byte / SRQ flag (bit 31)
; A2 - pointer to buffer containing receive data
; A3 - pointer to ADBBase
;
; Outputs: D2 - length of receive buffer data
; D3 - command byte / SRQ flag (bit 31)
; A0 - pointer to buffer to pass to completion routine
; A2 - pointer to buffer containing receive data
; A3 - pointer to ADBBase
; 0(SP) - completion routine address
; 4(SP) - optional data to pass in A2 to completion routine
; 8(SP) - stack cutback address, after completion routine runs
;
; Destroys: D0, D1, A0, A1
; Calls: exits through RequestDone
;
; Function: Locates the paramaters to pass to the service routine.
;
;_______________________________________________________________________
with ADBDeviceEntry
ImplicitRequestDone
tst.b d2 ; see if any data returned
beq.s RunADBRequest ; if no data, ack the data, resume ADB operations
move.b d3,d0 ; get command that completed
lsr.b #4,d0 ; get the address from the command
FFI1 jsrROM FindFDBInfo ; get the info for this device (FindFDBInfo)
bne RunADBRequest ; if unknown, ack the data, resume ADB operations
suba.w #12,sp ; allocate a buffer (len byte, 8 data bytes, 3 slop)
movea.l sp,a0 ; save pointer to buffer
pea 12(sp) ; save stack restore address
move.l fDBOpData(a1),-(sp) ; copy fDBOpData to A2 save area on stack
move.l fDBCRA(a1),-(sp) ; copy fDBCRA to A1 save area on stack
*Fall Into* bra.s RequestDone ; copy buffer data, resume ADB, call handler
endwith
Title 'KbdADB - ADB Manager - RequestDone'
;_______________________________________________________________________
;
; Routine: RequestDone
; Inputs: D2 - length of receive buffer data
; D3 - command byte / SRQ flag (bit 31)
; A0 - pointer to buffer to pass to completion routine
; A2 - pointer to buffer containing receive data
; A3 - pointer to ADBBase
; 0(SP) - completion routine address
; 4(SP) - optional data to pass in A2 to completion routine
; 8(SP) - stack cutback address, after completion routine runs
;
; Outputs: none
;
; Destroys: A0-A3/D0-D3
; Calls: device handler completion routine
;
; Function: Copies the receive data into the proper buffer, resumes ADB
; operations, and calls the device handler completion routine.
;
;_______________________________________________________________________
RequestDone move.l a0,-(sp) ; copy buffer address to A0 save area on stack
beq.s @copyDone ; if no buffer, don't copy <1.8>
move.b d2,(a0)+ ; copy length byte to form pascal string
beq.s @copyDone ; if no data, don't copy
subq.w #1,d2 ; adjust count for dbra loop
@copyLoop move.b (a2)+,(a0)+ ; copy a byte at a time
dbra d2,@copyLoop ; loop for all bytes
@copyDone move.l d3,-(sp) ; copy command byte to D0 save area on stack
bsr.w RunADBRequest ; acknowledge the data, resume ADB operations
movem.l (sp)+,d0/a0/a1/a2 ; setup cmd, buffer, handler, data
move.l a1,d1 ; test to see if handler address is valid
beq.s @noHandler ; if not, don't call it
jsr (a1) ; call the handler
@noHandler
movea.l (sp),sp ; deallocate the buffer (if implicit cmd)
rts ; return from the interrupt
Title 'KbdADB - ADB Manager - StartReqVIA'
;_______________________________________________________________________
;
; Routine: StartReqVIA
; Inputs: D2 - length of transmit buffer data
; D3 - command byte / implicit flag (bit 31)
; A2 - pointer to buffer containing transmit data
; A3 - pointer to ADBBase
;
; Outputs: A1 - pointer to VIA1
; A3 - pointer to ADBBase
;
; Destroys:
; Calls: RunADBRequest, @sendCmd, @waitForInput, @getNextByte
; @sendFirstByte, @sendNextByte
;
; Function: Initiates an asynchronous ADB request, using the VIA interface
; to the ADB transceiver processor.
;
;_______________________________________________________________________
StartReqVIA
with ADBVars
movea.l VIA,a1 ; get pointer to VIA
bset.b #fDBBusy,FDBAuFlag(a3) ; remember that we are busy
beq.s @notBusy ; if not busy, proceed
rts ; if busy, do nothing and return
@notBusy tst.l d3 ; see if implicit
bpl.s @explicit ; implicit is special case
; send an implicit command (auto / SRQ polling), no data needs to be sent
@implicit move.b PollAddr(a3),d3 ; get the auto/srq polling address
lsl.b #4,d3 ; position the address
ori.b #talkCmd+0,d3 ; make it a Talk R0 command
bsr.w @sendCmd ; send out the command byte
beq.s @autoReply ; see if prior auto poll data returned instead
move.b fDBCmd(a3),pollCmd(a3) ; remember the command byte
bsr.s @StartAutoPoll ; start auto polling
btst.b #fDBQEmpty,FDBFlag(a3) ; see if anything queued
bne.s @idle ; if not, just wait for auto poll data
; we have just changed from state 0 to state 3, if a command is in the queue, we will
; want to change back to state 0, and send a new command. We have to give the xcvr
; processor time to recognize the state change into state 3, before we change back to
; state 0. Otherwise it will be out of sync.
pea RunADBRequest ; somthing in queue, run after a short delay
move.w TimeViaDB,d0 ; get 1ms VIA loop time constant
IF forSTP601 THENB
;•••• STP ••• eric -- let's double it??
lsr.w #2,d0 ; 1ms/8 = 125µs
ELSE
lsr.w #4,d0 ; 1ms/16 = 62.5µs
ENDIF
@delay
eieioSTP
btst.b #0,vBufB(a1) ; timing base on BTST loop, we don't care
eieioSTP
dbra d0,@delay ; wait at least 50µs for state change to occur
@idle bclr.b #fDBBusy,FDBAuFlag(a3) ; allow explicit cmds to interrupt auto polling
rts ; if not, just let auto polling continue
@StartAutoPoll
moveq.l #(1<<vFDesk1)|\
(1<<vFDesk2),d1 ; change from state 0 to state 3
bsr.w @waitForInput ; start auto polling, wait for a reply
ori.b #(1<<fDBAPoll)|\ ; indicate that auto poll data returned
(1<<fDBBusy),FDBAuFlag(a3) ; auto poll found something, we're busy again
moveq.l #(1<<vFDesk2),d1 ; change from state 3 to state 1
bra.s @getReply ; join common code to get reply
@explicit moveq.l #maskADBCmd,d0 ; setup to extract command
and.b d3,d0 ; clear addr and reg
subq.b #listenCmd,d0 ; check for listen command
beq.w @listen ; explicit listen is special case
eject
; send an explicit command (other than listen), no data needs to be sent
bsr.s @sendCmd ; send out the command byte
bne.s @explicitReply ; see if auto poll data returned instead
@autoReply bset.b #fDBAPoll,FDBAuFlag(a3) ; indicate that auto poll data returned
move.b pollCmd(a3),fDBCmd(a3) ; poll command is command that is completing
@explicitReply
moveq.l #(1<<vFDesk1),d1 ; change from state 0 to state 1
@getReply bsr.s @waitForInput ; wait for the first byte
bne.s @noTimeout ; see if timeout occured
bset.b #fDBNoReply,FDBAuFlag(a3) ; indicate that no reply data was returned
@noTimeout clr.b fDBCnt(a3) ; indicate buffer empty
bsr.s @getNextByte ; wait for the second byte
bne.s @noSRQ ; see if SRQ occured
bset.b #fDBSRQ,FDBAuFlag(a3) ; indicate that no service request was returned
@noSRQ
@fetchLoop bsr.s @getNextByte ; wait for another byte
beq.s @fetchDone ; exit if end of data reached
cmpi.b #8,fDBCnt(a3) ; see if end of buffer reached
blo.s @fetchLoop ; keep fetching until end of data
@fetchDone btst.b #fDBNoReply,FDBAuFlag(a3) ; see if buffer data is valid
seq.b d0 ; $FF if data is valid, $00 if no reply
and.b d0,fDBCnt(a3) ; set count to zero if timeout
bra.w ReqDoneVIA
@sendCmd andi.b #$FF-(\
(1<<fDBAPoll)|\ ; clear auto poll reply flag
(1<<fDBSRQ)|\ ; clear SRQ active in reply flag
(1<<fDBNoReply)),\ ; clear reply timeout flag
FDBAuFlag(a3) ; clear the flags
move.w sr,d0 ; save int mask
ori.w #NoIntMask,sr ; disable all interrupts <1.2>
;
; This change (8) will take effect for TheFuture. Dont use it for anything
; earlier.
;
if TheFuture then ; <9>
eieioSTP
move.b vBufB(a1),d1 ; get current state <8>
eieioSTP
andi.b #(1<<vFDesk2)+\
(1<<vFDesk1),d1 ; <8>
cmpi.b #(1<<vFDesk2)+\
(1<<vFDesk1),d1 ; are we in state 3? <8>
bne.s @sendCont ; no, procede as usual <8>
eieioSTP
btst.b #vFDBInt,vBufB(a1) ; yes, test the FDBInt~ status <8>
eieioSTP
beq.s @sendExit ; asserted, xcvr already clocking autopoll data,<8>
; exit (wait for autopoll to complete) <8>
endif ; <9>
@sendCont
eieioSTP
ori.b #$1C,vACR(a1) ; set SR to shift-out with ext clk
eieioSTP
move.b d3,vSR(a1) ; load shift reg with cmd, start shifting
eieioSTP
move.b d3,fDBCmd(a3) ; save the command
eieioSTP
andi.b #-1-(1<<vFDesk2)-\
(1<<vFDesk1),vBufB(a1) ; force state bits to zero
eieioSTP
@sendExit move.l (sp)+,ShiftIntResume(a3); save resume address
move.w d0,sr ; restore interrupt mask
rts ; return to callers caller, wait for interrupt
@waitForInput
eieioSTP
bclr.b #4,vACR(a1) ; change to shift-in mode
eieioSTP
tst.b vSR(a1) ; empty shift reg to start shifting
eieioSTP
eor.b d1,vBufB(a1) ; change the state
eieioSTP
move.l (sp)+,ShiftIntResume(a3) ; save resume address
rts ; return to callers caller, wait for interrupt
@getNextByte
lea fDBCnt(a3),a0 ; point to the length byte of the buffer
moveq.l #1,d0 ; zero extend the index
add.b (a0),d0 ; get, and increment the index
move.b d0,(a0) ; update the index
eieioSTP
move.b vSR(a1),(a0,d0.w) ; save the new byte in the buffer
eieioSTP
eori.b #(1<<vFDesk1)|\
(1<<vFDesk2),vBufB(a1) ; alternate between state 1 and state 2
eieioSTP
move.l (sp)+,ShiftIntResume(a3) ; save resume address
rts ; return to callers caller, wait for interrupt
eject
; send an explicit Listen command, send data buffer.
; Inputs: D2 - length of transmit buffer data
; D3 - command byte / implicit flag (bit 31)
; A2 - pointer to buffer containing transmit data
; A3 - pointer to ADBBase
@listen subq.b #2,d2 ; check for min length of 2
bhs.s @minOK ; if >= 2, use it
moveq.l #0,d2 ; otherwise use 0, which will become 2
@minOK subq.b #8-2,d2 ; check for max length of 8
bls.s @maxOK ; if <= 8, use it
moveq.l #0,d2 ; otherwise use 0, which will become 8
@maxOK addq.b #8,d2 ; restore count
move.b d2,fDBCnt(a3) ; update buffer length
move.l a2,ListenBuffPtr(a3); save buffer starting address
bsr.s @sendCmd ; send out the command byte
beq.w @autoReply ; see if auto poll data returned instead
bsr.s @sendFirstByte ; send the first byte
bne.s @noListenTimeout ; see if timeout occured
bset.b #fDBNoReply,FDBAuFlag(a3) ; indicate that no reply data was returned
@noListenTimeout
bsr.s @sendNextByte ; send the second byte
bne.s @sendLoop ; if no SRQ, send the data
bset.b #fDBSRQ,FDBAuFlag(a3) ; remember that a service request was returned
@sendLoop tst.b fDBCnt(a3) ; see if end of buffer reached
beq.s ReqDoneVIA ; leave when count is zero, no reply data
bsr.s @sendNextByte ; send another byte
bra.s @sendLoop ; loop until count exhausted
@sendFirstByte
moveq.l #(1<<vFDesk1),d1 ; change from state 0 to state 1
bra.s @sendByte ; join common code
@sendNextByte
moveq.l #(1<<vFDesk1)|\
(1<<vFDesk2),d1 ; alternate between state 1 and state 2
@sendByte movea.l ListenBuffPtr(a3),a0; get the buffer pointer
eieioSTP
move.b (a0)+,vSR(a1) ; send the byte
eieioSTP
move.l a0,ListenBuffPtr(a3); update the buffer pointer
subq.b #1,fDBCnt(a3) ; decrement the send count
eieioSTP
eor.b d1,vBufB(a1) ; change the state
eieioSTP
move.l (sp)+,ShiftIntResume(a3) ; save resume address
rts ; return to callers caller, wait for interrupt
;_______________________________________________________________________
; Routine: FDBShiftInt
; Inputs: A1 - base address of VIA1 (setup by IntHnd)
; Outputs: A1 - base address of VIA1
; A3 - pointer to ADBBase
; ccr.z - result of BTST #vFDBInt,vBufB(a1)
;
; Function: handles shift interrupt, resumes asynchronous processing
;_______________________________________________________________________
FDBShiftInt
movea.l ADBBase,a3 ; point to ADB globals in low memory
movea.l ShiftIntResume(a3),a0 ; get address to resume at
eieioSTP
btst.b #vFDBInt,vBufB(a1) ; test the FDBInt~ status
eieioSTP
jmp (a0) ; resume async processing
Title 'KbdADB - ADB Manager - ReqDoneVIA'
;_______________________________________________________________________
;
; Routine: ReqDoneVIA
; Inputs: none
;
; Outputs: D2 - length of receive buffer data
; D3 - command byte / SRQ flag (bit 31)
; A2 - pointer to buffer containing receive data
; A3 - pointer to ADBBase
;
;
; Destroys:
; Calls: ImplicitRequestDone, ExplicitRequestDone
;
; Function: Completion routine for servicing replies from the ADB xcvr.
;
;_______________________________________________________________________
ReqDoneVIA
with ADBVars
move.b FDBAuFlag(a3),d0 ; get the flags
move.b fDBCmd(a3),d1 ; get the command
moveq.l #(1<<fDBSRQ),d3 ; mask to test for SRQ pending
and.b d0,d3 ; isolate the bit
neg.l d3 ; set bit 31 if SRQ pending
move.b d1,d3 ; insert the command byte
move.w DevMap(a3),d2 ; list of possible address to search <1.2>
lsr.b #4,d1 ; isolate the device address
tst.l d3 ; was there an SRQ?
bpl.s @noSRQ ; if not, don't advance poll address
bset.l d1,d2 ; if no other bits set, come back to this one
@SRQloop addq.b #1,d1 ; try the next address
andi.b #$0F,d1 ; wrapping around if needed <1.2>
btst.l d1,d2 ; see if there is a device with that address
beq.s @SRQloop ; if not, try the next address
@updateAddr move.b d1,PollAddr(a3) ; remember where to auto/SRQ poll next <1.2>
@skipUpdate lea fDBCnt(a3),a0 ; point to the length byte of the buffer <1.2>
moveq #0,d2 ; zero extend the length
move.b (a0)+,d2 ; get length of receive data
movea.l a0,a2 ; point to the data buffer
clr.b FDBAuFlag(a3) ; clear the flags, especially fDBBusy
btst.l #fDBAPoll,d0 ; see what kind of request completed
bne.w ImplicitRequestDone ; auto poll data returned, call handler
bra.w ExplicitRequestDone ; if explicit, call the completion routine
@noSRQ btst.l d1,d2 ; see if there is a device with this address <1.2>
beq.s @skipUpdate ; if not, don't make it the active device <1.2>
bra.s @updateAddr ; if so, update the poll address <1.2>
Title 'KbdADB - ADB Manager - Initialization'
;_______________________________________________________________________
;
; BusReset - issue a Reset command
;
; On entry, (SP) has completion routine address <1.6>
;
;_______________________________________________________________________
BusReset moveq.l #0,d0 ; address zero
moveq.l #resetCmd,d1 ; reset command
moveq.l #0,d2 ; no data to send
bra.s MakeAsyncRequest ; start the command asynchronously
;_______________________________________________________________________
;
; Talk R3 - issue a Talk R3 command
;
; On entry, D0 has device address
; (SP) has completion routine address <1.6>
;
;_______________________________________________________________________
TalkR3 moveq.l #talkCmd+3,d1 ; talk command, register 3
moveq.l #0,d2 ; no data to send
bra.s MakeAsyncRequest ; start the command asynchronously
;_______________________________________________________________________
;
; ListenR3 - issue a listen R3 command
;
; On entry, D0 has device address to send the command
; D1 has new device address to change to
; (SP) has completion routine address <1.6>
;
;_______________________________________________________________________
ListenR3 move.b d1,FDBByte0(a3) ; set up new address for R3
move.b #$FE,FDBByte1(a3) ; setup handle ID
moveq.l #listenCmd+3,d1 ; listen command, register 3
moveq.l #2,d2 ; 2 bytes of data to send
MakeAsyncRequest
lsl.b #4,d0 ; shift address by 4 bits to correct position
or.b d1,d0 ; insert the command and register number
move.b d2,FDBCnt(a3) ; setup the send byte count
pea FDBCnt(a3) ; push the buffer address
movea.l sp,a0 ; setup param block pointer
movea.l jADBop,a1 ; get address of _ADBop
jsr (a1) ; start the request
addq.w #8,sp ; pop buffer addr and return address
rts ; return to callers caller
;_______________________________________________________________________
;
; FDBTask - FDB VBL Task
;
;_______________________________________________________________________
FDBTask
RTS ; just return for now
;_______________________________________________________________________
;
; InitDevT - Initialize the Device Table
;
;_______________________________________________________________________
InitDevT
with ADBVars,ADBDeviceEntry
bsr.s BusReset ; reset all devices on the bus
clr.b DevTOffset(a3) ; initialize the table offset
clr.w HasDev(a3) ; initialize the device map
moveq.l #0,d0 ; start with address zero
PollNext move.b d0,InitAddr(a3) ; save device address
bsr.s TalkR3 ; issue a Talk R3 command (asynchronously)
move.b InitAddr(a3),d0 ; restore poll address
tst.b (a0)+ ; test reply length, see if device returned data
beq.s NoDevice ; no, nothing to install
; there is a response from the device in the address, so update the
; device table according to the device
moveq.l #0,d1 ; zero extend for indexing
move.b DevTOffset(a3),d1 ; get offset to devicetable
move.b 1(a0),FDBDevTy(a3,d1.w) ; copy device handler ID into table
move.b d0,FDBOAddr(a3,d1.w); save device address
move.b d0,FDBAddr(a3,d1.w) ; save device address
addi.b #FRecSize,d1 ; advance offset
move.b d1,DevTOffset(a3) ; save device table offset
move.w HasDev(a3),d2 ; get value in HasDev
bset.l d0,d2 ; remember which address has device
move.w d2,HasDev(A3) ; save it
NoDevice
addq.b #1,d0 ; advance device address
cmpi.b #NumFDBAdr,d0 ; has it polled all addresses yet?
bne.s PollNext ; no, go to poll next device
; ChgAddr - check the device address to identify multiple devices on
; the same address
move.b #MoveTime+1,FDBMvCnt(A3); initialize move retry count
move.w HasDev(a3),DevMap(a3) ; initialize device map
Bne.S movLoop ; branch, if there is no device
ChgExit
; now setup auto poll for the mouse
BClr #FDBInit,FDBFlag(A3); done with initialization
JSR RunADBRequest ; start auto poll for the mouse
RTS
movLoop
ST InitAddr(A3) ; clear poll address
subq.b #1,FDBMvCnt(A3) ; has it loop 50 times yet?
Beq.S ChgExit ; yes, exit
; ChgNext is another entry point for this routine
ChgNext
AddQ.B #1,InitAddr(A3) ; advance poll address
BSR GNextAddr ; get next address to change
Bmi.S MovLoop ; exit when end of address range
GE1 jsrROM GEmptyAddr ; get empty address space, D0 gets address (GEmptyAddr)
BMI.S ChgExit ; no more empty address space, exit
; D0 has an address that can be moved to
Move.B D0,NewAddr(A3) ; save address in NewAddr
Move.B D0,D1 ; D1 get new address to change to
Move.B InitAddr(A3),D0 ; D0 get address to issue command
BSR ListenR3 ; issue a Listen R3 command
; MovAddr - a Listen R3 command has just been issued, the device is moved to
; a new address. Now issue a Talk R3 to the old address. A timeout would
; indicate no more device in the old address, we will move the device back
; to the old address by issuing a Listen R3.
Move.B InitAddr(A3),D0 ; get address
BSR TalkR3 ; issue a Talk R3 command <1.6>
; MovBack - A Talk R3 has just been issued, a timeout in S1 indicates no
; more device in original address, we want to move the device back to
; original address.
eieioSTP
tst.b (a0) ; did the device return data
eieioSTP
beq.S @1 ; no, branch
; no timeout indication,
bsr.s CopyEntry ; copy entry into device table
Move.B FDBByte1(A3),FDBDevTy(A3,D1.W) ; get new handle ID into table
BRA.S ChgNext ; go to change next devi]
; there is timeout indication
@1
Move.B InitAddr(A3),D1 ; get address to change back to
Move.B NewAddr(A3),D0 ; get address to talk to
bsr ListenR3 ; send a listen R3 command <1.6>
; CKNewAdr - check the new address by issuing a Talk R3, to see if
; there is still any device left. If yes, add entry into device
; table, but if not, just go to change next device address
Move.B NewAddr(A3),D0 ; get address
BSR TalkR3 ; issue a talk R3 <1.6>
; AddEntry - a Talk R3 command has just been issed to the new address,
; if there is no timeout in S1, one or more device is still in that
; address, so, add device to device table. If there is timeout, no
; device is in that address, so, just go to change next device address
tst.b (a0) ; did the device return data
Beq.S ExitEntry ; no, branch
; no timeout indication, thus, add entry of the new address into the
; device table.
bsr.s CopyEntry ; copy entry into device table
Move.B FDBByte1(A3),FDBDevTy-FRecSize(A3,D2.W) ; get new handle ID into table
ExitEntry
bra.s ChgNext ; go to change next device
;_______________________________________________________________________
;
; CopyEntry - copy the device entry from the original address to the
; new address, a Talk R3 had just been issued
;
; Called by: MoveBack and AddEntry
; on exit: D1 - has record address of old device
; D2 - points to new table entry
;_______________________________________________________________________
CopyEntry
MoveQ #0,D0
MoveQ #0,D1
Move.B NewAddr(A3),D0 ; get new address
Move.W DevMap(A3),D1 ; get device map
BSet D0,D1 ; set device address
Move.W D1,DevMap(A3) ; update device map
MoveQ #0,D1 ; set D1 as offset to table
Move.B InitAddr(A3),D0 ; D0 get address
@1
CMP.B FDBADDR(A3,D1.W),D0 ; same address?
BEQ.S @2 ; yes, branch
Add #FRecSize,D1 ; advance
BRA.S @1
@2
MoveQ #0,D2
Move.B DevToffset(A3),D2 ; set D2 to new entry offset
Move.L FDBDevTy(A3,D1.W),\ ; get first 4 byte
FDBDevTy(A3,D2.W) ; save it
Move.L FDBCRA(A3,D1.W),\ ; get completion routine address
FDBCRA(A3,D2.W) ; save it
Move.B NewAddr(A3),\ ; get new address
FDBAddr(A3,D2.W) ; update address
Add #FRecSize,D2 ; advance device table offset
Move.B D2,DevToffset(A3) ; save it
RTS
;_______________________________________________________________________
;
; GNextAddr - get next address to change
;
;_______________________________________________________________________
GNextAddr
MoveQ #0,D0
MoveQ #0,D1
Move.B InitAddr(A3),D0 ; get address
Move.W DevMap(A3),D1 ; get device map
@1
BTst D0,D1 ; is there a device there?
BNE.S @2 ; branch, if there is device
AddQ #1,D0 ; advance to next address
CMP #numFDBAdr,D0 ; end of address yet?
BLT.S @1 ; no, branch
MoveQ #-1,D0 ; return -1 if no more address
RTS
@2
Move.B D0,InitAddr(A3) ; remember the address
RTS
;_______________________________________________________________________
;
; Mouse Driver -- generate mouse button events when appropriate and updates
; mouse temporary position vars.
;
; Inputs: A0 - pointer to buffer containing receive data (Pascal string)
; A2 - Optional data (not used)
; D0 - command byte (not used)
;
;_______________________________________________________________________
MouseDrvr
lea 1(a0),a1 ; skip over length byte, free up A0
eieioSTP
move.b (a1)+,d2 ; get first data byte (button, ∆ Vert)
eieioSTP
; Update the mouse button state
move.b MBState,d1 ; get copy of last state
eor.b d2,d1 ; did it change?
bpl.s @ButtonDone ; if it didn't, no event
; If the mouse button bounces, we don't want it to look like a double click, so if we see
; a mouse down less than 2 VBLs after a mouse up, we will ignore it, and consider the mouse
; to still be up. We will never ignore a mouse up event, which could lead to menus hanging
; and continuous scrolling.
move.l Ticks,d1 ; get current system ticks
sub.l MBTicks,d1 ; compute time since last change
movea.w #mButUpEvt,a0 ; A0 holds the event (2 = mouse button up)
moveq.l #-1<<7,d0 ; mask for mouse button bit
and.b d2,d0 ; just store high bit
bmi.s @postButton ; if up, post it
subq.l #2,d1 ; see if less than 2 VBLs since last mouse up
blt.s @ButtonDone ; if too short, must be a down bounce, ignore it
addq.l #2,d1 ; restore change time
subq.w #mButUpEvt-mButDwnEvt,a0 ; if down, update event number and post it
@postButton move.b d0,MBState ; also update the state
add.l d1,MBTicks ; remember that it just changed
add.l d1,RndSeed ; randomize our seed
moveq.l #0,d0 ; no message for PostEvent
_PostEvent ; post the mouse button event
@ButtonDone
; Update the mouse vertical position
add.b d2,d2 ; shift high bit of ∆ into sign
beq.s @virtDone ; if no change, nothing to update
asr.b #1,d2 ; shift ∆ back, sign extended
ext.w d2 ; extend it to a word
add.w d2,mTemp+v ; update the virtical position
move.b CrsrCouple,CrsrNew ; note the change
@virtDone
; Update the mouse horizontal position
eieioSTP
move.b (a1),d2 ; get the ∆ Horiz (low 7 bits)
eieioSTP
add.b d2,d2 ; shift high bit of ∆ into sign
beq.s @horizDone ; if no change, nothing to update
asr.b #1,d2 ; shift ∆ back, sign extended
ext.w d2 ; extend it to a word
add.w d2,mTemp+h ; update the horizontal position
move.b CrsrCouple,CrsrNew ; note the change
@horizDone
rts ; mouse driver done
;______________________________________________________________________
;
; KbdInstall - allocate memory for keyboard information and put in ADB record,
; loading resources as necessary.
;
;______________________________________________________________________
; Keyboard driver data
KBufCount EQU 2
KBufLen EQU 10 ; 8 bytes + length + inuse
KMAPPtr EQU $00
KeyBits EQU KMAPPtr+4
KCHRPtr EQU KeyBits+(128/8)
DeadKey EQU KCHRPtr+4
KNoADBOp EQU DeadKey+4
KNumBufs EQU KNoADBOp+1
KFirstBuf EQU KNumBufs+1
KbdDSize EQU KFirstBuf+(KBufCount*KBufLen)
; KMAP offsets
KMid EQU $00
KMtype EQU $01
KMvers EQU KMid+2
KMstart EQU KMvers+2
KMnumEx EQU KMstart+128
KMstEx EQU KMnumEx+2
KbdInstall
with ADBDeviceEntry
MOVEQ #numFDBAdr, D1 ; Number of table entries
MOVE.L ADBBase, A1 ; Put Base in A1
BRA.S FirstInstall ; Skip past record increment
InstallLoop
ADD #FRecSize, A1 ; Get to next record
FirstInstall
MOVEQ #kbdAddr, D0 ; We're looking for keyboards
CMP.B FDBOAddr(A1), D0 ; Is this one?
BNE.S NotKbd ; Nope, skip around
MOVEQ #KbdDSize, D0 ; Amount of space needed for keyboard data
_NewPtr ,SYS,CLEAR ; get a pointer
MOVE.L A0, A2 ; Save it in A2
MOVE.B #KBufCount, KNumBufs(A2)
SUBQ.L #4, SP ; Make room for result
MOVE.L #'KCHR', -(SP) ; ResType = KCHR
CLR.W -(SP) ; theID = 0
MOVE.W #mapTrue, RomMapInsert ; Load it from ROM
_GetResource
MOVE.L (SP)+, D0 ; Get the handle
BEQ.S NotKbd ; Skip if NIL
MOVE.L D0, A0
MOVE.L (A0), KCHRPtr(A2) ; Dereference and put away
SUBQ.L #4, SP ; Make room for result
MOVE.L #'KMAP', -(SP) ; ResType = KCHR
CLR.W -(SP) ; theID = 0
MOVE.W #mapTrue, RomMapInsert ; Load it from ROM
_GetResource
MOVE.L (SP)+, D0 ; Get the handle
BEQ.S NotKbd ; Skip if NIL
MOVE.L D0, A0
MOVE.L (A0), KMAPPtr(A2) ; Dereference and put away
MOVE.L A2, FDBOpData(A1) ; Save pointer in ADB record
MOVE.B FDBDevTy(A1), KbdType ; Save the keyboard type
MOVE.B FDBAddr(A1), KbdLast ; Save the ADB address
NotKbd
DBRA D1, InstallLoop ; Loop until no more
RTS
endwith
ENDPROC
END