forked from Apple-2-HW/Apple2-IO-RPi
Add RAM based ProDOS driver for testing
This commit is contained in:
Terence Boldt
parent
7acbbc1d26
commit
8dff6e4765
181
Firmware/Driver.asm
Normal file
181
Firmware/Driver.asm
Normal file
@ -0,0 +1,181 @@
|
|||||||
|
; ProDOS Global Page
|
||||||
|
Device2S1 = $bf14 ;POINTER FOR SLOT 2 DRIVE 1 DRIVER
|
||||||
|
DeviceCount = $bf31 ;DEVICE COUNT -1
|
||||||
|
DeviceList = $bf32 ;DEVICE LIST
|
||||||
|
|
||||||
|
; ProDOS Zero Page
|
||||||
|
Command = $42 ;ProDOS Command
|
||||||
|
Unit = $43 ;ProDOS unit (SDDD0000)
|
||||||
|
BufferLo = $44
|
||||||
|
BufferHi = $45
|
||||||
|
BlockLo = $46
|
||||||
|
BlockHi = $47
|
||||||
|
|
||||||
|
; ProDOS Error Codes
|
||||||
|
IOError = $27
|
||||||
|
NoDevice = $28
|
||||||
|
WriteProtect = $2B
|
||||||
|
|
||||||
|
SlotDrive = $50
|
||||||
|
InputByte = $c0de
|
||||||
|
OutputByte = $c0dd
|
||||||
|
ReadBlockCommand = $01
|
||||||
|
WriteBlockCommand = $02
|
||||||
|
NibbleStorage = $1d
|
||||||
|
|
||||||
|
.org $1000
|
||||||
|
|
||||||
|
; Register the driver with ProDOS
|
||||||
|
lda #<Driver
|
||||||
|
sta Device2S1
|
||||||
|
lda #>Driver
|
||||||
|
sta Device2S1+1
|
||||||
|
; Add the drive to the device list
|
||||||
|
inc DeviceCount
|
||||||
|
lda DeviceCount
|
||||||
|
lda #SlotDrive
|
||||||
|
sta DeviceList,y
|
||||||
|
rts
|
||||||
|
|
||||||
|
; ProDOS Driver code
|
||||||
|
; First check that this is the right drive
|
||||||
|
Driver:
|
||||||
|
lda Unit
|
||||||
|
cmp #SlotDrive
|
||||||
|
beq DoCommand ;correct device, so proceed
|
||||||
|
sec ;set carry as ProDOS treats this as an error
|
||||||
|
lda #NoDevice ;put the error code in accumulator for ProDOS
|
||||||
|
rts
|
||||||
|
|
||||||
|
; Check which command is being requested
|
||||||
|
DoCommand:
|
||||||
|
lda Command
|
||||||
|
beq GetStatus ;0 = Status command
|
||||||
|
cmp #ReadBlockCommand
|
||||||
|
beq ReadBlock
|
||||||
|
cmp #WriteBlockCommand
|
||||||
|
beq WriteBlock
|
||||||
|
sec ;set carry as we don't support any other commands
|
||||||
|
lda #$53 ;Invalid parameter error
|
||||||
|
rts
|
||||||
|
|
||||||
|
; ProDOS Status Command Handler
|
||||||
|
GetStatus:
|
||||||
|
lda #$00 ;0 indicates ready to read/write
|
||||||
|
lda #$ff ;low byte number of blocks
|
||||||
|
lda #$ff ;high byte number of blocks
|
||||||
|
lda #$0 ;zero accumulator and clear carry for success
|
||||||
|
clc
|
||||||
|
rts
|
||||||
|
|
||||||
|
; ProDOS Read Block Command
|
||||||
|
ReadBlock:
|
||||||
|
lda #ReadBlockCommand
|
||||||
|
jsr SendCommand
|
||||||
|
lda BlockLo
|
||||||
|
jsr SendByte
|
||||||
|
lda BlockHi
|
||||||
|
jsr SendByte
|
||||||
|
ldy #$0
|
||||||
|
jsr read256
|
||||||
|
inc BufferHi
|
||||||
|
jsr read256
|
||||||
|
dec BufferHi
|
||||||
|
lda #$0 ;zero accumulator and clear carry for success
|
||||||
|
clc
|
||||||
|
rts
|
||||||
|
|
||||||
|
read256:
|
||||||
|
jsr GetByte
|
||||||
|
sta (BufferLo),y
|
||||||
|
iny
|
||||||
|
bne read256
|
||||||
|
rts
|
||||||
|
|
||||||
|
; ProDOS Write Block Command
|
||||||
|
WriteBlock:
|
||||||
|
lda #WriteBlockCommand
|
||||||
|
jsr SendCommand
|
||||||
|
lda BlockLo
|
||||||
|
jsr SendByte
|
||||||
|
lda BlockHi
|
||||||
|
jsr SendByte
|
||||||
|
ldy #$0
|
||||||
|
jsr write256
|
||||||
|
inc BufferHi
|
||||||
|
jsr write256
|
||||||
|
dec BufferHi
|
||||||
|
lda #$0 ;zero accumulator and clear carry for success
|
||||||
|
clc
|
||||||
|
rts
|
||||||
|
|
||||||
|
write256:
|
||||||
|
lda (BufferLo),y
|
||||||
|
jsr SendByte
|
||||||
|
iny
|
||||||
|
bne write256
|
||||||
|
rts
|
||||||
|
|
||||||
|
SendCommand:
|
||||||
|
ora #$D0 ;Write Hi, Read Hi, Command Write Lo, Command Read Hi
|
||||||
|
sta OutputByte
|
||||||
|
commandWait:
|
||||||
|
lda InputByte
|
||||||
|
asl
|
||||||
|
asl
|
||||||
|
asl
|
||||||
|
bmi commandWait
|
||||||
|
lda #$F0 ;set write/read/command flags high
|
||||||
|
sta OutputByte
|
||||||
|
rts
|
||||||
|
|
||||||
|
SendByte:
|
||||||
|
pha
|
||||||
|
lsr
|
||||||
|
lsr
|
||||||
|
lsr
|
||||||
|
lsr
|
||||||
|
jsr SendNibble
|
||||||
|
pla
|
||||||
|
jsr SendNibble
|
||||||
|
rts
|
||||||
|
|
||||||
|
SendNibble:
|
||||||
|
and #$0F
|
||||||
|
ora #$70 ;Write bit low
|
||||||
|
pha
|
||||||
|
waitWrite:
|
||||||
|
lda InputByte
|
||||||
|
asl ;Second highest bit goes low when ready
|
||||||
|
bmi waitWrite
|
||||||
|
pla
|
||||||
|
sta OutputByte
|
||||||
|
finishWrite:
|
||||||
|
lda InputByte
|
||||||
|
asl
|
||||||
|
bpl finishWrite
|
||||||
|
rts
|
||||||
|
|
||||||
|
GetByte:
|
||||||
|
jsr GetNibble
|
||||||
|
asl
|
||||||
|
asl
|
||||||
|
asl
|
||||||
|
asl
|
||||||
|
sta NibbleStorage
|
||||||
|
jsr GetNibble
|
||||||
|
and #$0f
|
||||||
|
ora NibbleStorage
|
||||||
|
lda NibbleStorage
|
||||||
|
rts
|
||||||
|
|
||||||
|
GetNibble:
|
||||||
|
lda #$b0 ;set read flag low
|
||||||
|
sta OutputByte
|
||||||
|
waitRead:
|
||||||
|
lda InputByte
|
||||||
|
bmi waitRead
|
||||||
|
and #$f0 ;set all flags high
|
||||||
|
sta OutputByte
|
||||||
|
rts
|
||||||
|
|
||||||
186
Firmware/Driver.lst
Normal file
186
Firmware/Driver.lst
Normal file
@ -0,0 +1,186 @@
|
|||||||
|
ca65 V2.18 - Ubuntu 2.18-1
|
||||||
|
Main file : Driver.asm
|
||||||
|
Current file: Driver.asm
|
||||||
|
|
||||||
|
000000r 1 ; ProDOS Global Page
|
||||||
|
000000r 1 Device2S1 = $bf14 ;POINTER FOR SLOT 2 DRIVE 1 DRIVER
|
||||||
|
000000r 1 DeviceCount = $bf31 ;DEVICE COUNT -1
|
||||||
|
000000r 1 DeviceList = $bf32 ;DEVICE LIST
|
||||||
|
000000r 1
|
||||||
|
000000r 1 ; ProDOS Zero Page
|
||||||
|
000000r 1 Command = $42 ;ProDOS Command
|
||||||
|
000000r 1 Unit = $43 ;ProDOS unit (SDDD0000)
|
||||||
|
000000r 1 BufferLo = $44
|
||||||
|
000000r 1 BufferHi = $45
|
||||||
|
000000r 1 BlockLo = $46
|
||||||
|
000000r 1 BlockHi = $47
|
||||||
|
000000r 1
|
||||||
|
000000r 1 ; ProDOS Error Codes
|
||||||
|
000000r 1 IOError = $27
|
||||||
|
000000r 1 NoDevice = $28
|
||||||
|
000000r 1 WriteProtect = $2B
|
||||||
|
000000r 1
|
||||||
|
000000r 1 SlotDrive = $50
|
||||||
|
000000r 1 InputByte = $c0de
|
||||||
|
000000r 1 OutputByte = $c0dd
|
||||||
|
000000r 1 ReadBlockCommand = $01
|
||||||
|
000000r 1 WriteBlockCommand = $02
|
||||||
|
000000r 1 NibbleStorage = $1d
|
||||||
|
000000r 1
|
||||||
|
000000r 1 .org $1000
|
||||||
|
001000 1
|
||||||
|
001000 1 ; Register the driver with ProDOS
|
||||||
|
001000 1 A9 16 lda #<Driver
|
||||||
|
001002 1 8D 14 BF sta Device2S1
|
||||||
|
001005 1 A9 10 lda #>Driver
|
||||||
|
001007 1 8D 15 BF sta Device2S1+1
|
||||||
|
00100A 1 ; Add the drive to the device list
|
||||||
|
00100A 1 EE 31 BF inc DeviceCount
|
||||||
|
00100D 1 AD 31 BF lda DeviceCount
|
||||||
|
001010 1 A9 50 lda #SlotDrive
|
||||||
|
001012 1 99 32 BF sta DeviceList,y
|
||||||
|
001015 1 60 rts
|
||||||
|
001016 1
|
||||||
|
001016 1 ; ProDOS Driver code
|
||||||
|
001016 1 ; First check that this is the right drive
|
||||||
|
001016 1 Driver:
|
||||||
|
001016 1 A5 43 lda Unit
|
||||||
|
001018 1 C9 50 cmp #SlotDrive
|
||||||
|
00101A 1 F0 04 beq DoCommand ;correct device, so proceed
|
||||||
|
00101C 1 38 sec ;set carry as ProDOS treats this as an error
|
||||||
|
00101D 1 A9 28 lda #NoDevice ;put the error code in accumulator for ProDOS
|
||||||
|
00101F 1 60 rts
|
||||||
|
001020 1
|
||||||
|
001020 1 ; Check which command is being requested
|
||||||
|
001020 1 DoCommand:
|
||||||
|
001020 1 A5 42 lda Command
|
||||||
|
001022 1 F0 0C beq GetStatus ;0 = Status command
|
||||||
|
001024 1 C9 01 cmp #ReadBlockCommand
|
||||||
|
001026 1 F0 12 beq ReadBlock
|
||||||
|
001028 1 C9 02 cmp #WriteBlockCommand
|
||||||
|
00102A 1 F0 36 beq WriteBlock
|
||||||
|
00102C 1 38 sec ;set carry as we don't support any other commands
|
||||||
|
00102D 1 A9 53 lda #$53 ;Invalid parameter error
|
||||||
|
00102F 1 60 rts
|
||||||
|
001030 1
|
||||||
|
001030 1 ; ProDOS Status Command Handler
|
||||||
|
001030 1 GetStatus:
|
||||||
|
001030 1 A9 00 lda #$00 ;0 indicates ready to read/write
|
||||||
|
001032 1 A9 FF lda #$ff ;low byte number of blocks
|
||||||
|
001034 1 A9 FF lda #$ff ;high byte number of blocks
|
||||||
|
001036 1 A9 00 lda #$0 ;zero accumulator and clear carry for success
|
||||||
|
001038 1 18 clc
|
||||||
|
001039 1 60 rts
|
||||||
|
00103A 1
|
||||||
|
00103A 1 ; ProDOS Read Block Command
|
||||||
|
00103A 1 ReadBlock:
|
||||||
|
00103A 1 A9 01 lda #ReadBlockCommand
|
||||||
|
00103C 1 20 8A 10 jsr SendCommand
|
||||||
|
00103F 1 A5 46 lda BlockLo
|
||||||
|
001041 1 20 9D 10 jsr SendByte
|
||||||
|
001044 1 A5 47 lda BlockHi
|
||||||
|
001046 1 20 9D 10 jsr SendByte
|
||||||
|
001049 1 A0 00 ldy #$0
|
||||||
|
00104B 1 20 59 10 jsr read256
|
||||||
|
00104E 1 E6 45 inc BufferHi
|
||||||
|
001050 1 20 59 10 jsr read256
|
||||||
|
001053 1 C6 45 dec BufferHi
|
||||||
|
001055 1 A9 00 lda #$0 ;zero accumulator and clear carry for success
|
||||||
|
001057 1 18 clc
|
||||||
|
001058 1 60 rts
|
||||||
|
001059 1
|
||||||
|
001059 1 read256:
|
||||||
|
001059 1 20 C0 10 jsr GetByte
|
||||||
|
00105C 1 91 44 sta (BufferLo),y
|
||||||
|
00105E 1 C8 iny
|
||||||
|
00105F 1 D0 F8 bne read256
|
||||||
|
001061 1 60 rts
|
||||||
|
001062 1
|
||||||
|
001062 1 ; ProDOS Write Block Command
|
||||||
|
001062 1 WriteBlock:
|
||||||
|
001062 1 A9 02 lda #WriteBlockCommand
|
||||||
|
001064 1 20 8A 10 jsr SendCommand
|
||||||
|
001067 1 A5 46 lda BlockLo
|
||||||
|
001069 1 20 9D 10 jsr SendByte
|
||||||
|
00106C 1 A5 47 lda BlockHi
|
||||||
|
00106E 1 20 9D 10 jsr SendByte
|
||||||
|
001071 1 A0 00 ldy #$0
|
||||||
|
001073 1 20 81 10 jsr write256
|
||||||
|
001076 1 E6 45 inc BufferHi
|
||||||
|
001078 1 20 81 10 jsr write256
|
||||||
|
00107B 1 C6 45 dec BufferHi
|
||||||
|
00107D 1 A9 00 lda #$0 ;zero accumulator and clear carry for success
|
||||||
|
00107F 1 18 clc
|
||||||
|
001080 1 60 rts
|
||||||
|
001081 1
|
||||||
|
001081 1 write256:
|
||||||
|
001081 1 B1 44 lda (BufferLo),y
|
||||||
|
001083 1 20 9D 10 jsr SendByte
|
||||||
|
001086 1 C8 iny
|
||||||
|
001087 1 D0 F8 bne write256
|
||||||
|
001089 1 60 rts
|
||||||
|
00108A 1
|
||||||
|
00108A 1 SendCommand:
|
||||||
|
00108A 1 09 D0 ora #$D0 ;Write Hi, Read Hi, Command Write Lo, Command Read Hi
|
||||||
|
00108C 1 8D DD C0 sta OutputByte
|
||||||
|
00108F 1 commandWait:
|
||||||
|
00108F 1 AD DE C0 lda InputByte
|
||||||
|
001092 1 0A asl
|
||||||
|
001093 1 0A asl
|
||||||
|
001094 1 0A asl
|
||||||
|
001095 1 30 F8 bmi commandWait
|
||||||
|
001097 1 A9 F0 lda #$F0 ;set write/read/command flags high
|
||||||
|
001099 1 8D DD C0 sta OutputByte
|
||||||
|
00109C 1 60 rts
|
||||||
|
00109D 1
|
||||||
|
00109D 1 SendByte:
|
||||||
|
00109D 1 48 pha
|
||||||
|
00109E 1 4A lsr
|
||||||
|
00109F 1 4A lsr
|
||||||
|
0010A0 1 4A lsr
|
||||||
|
0010A1 1 4A lsr
|
||||||
|
0010A2 1 20 AA 10 jsr SendNibble
|
||||||
|
0010A5 1 68 pla
|
||||||
|
0010A6 1 20 AA 10 jsr SendNibble
|
||||||
|
0010A9 1 60 rts
|
||||||
|
0010AA 1
|
||||||
|
0010AA 1 SendNibble:
|
||||||
|
0010AA 1 29 0F and #$0F
|
||||||
|
0010AC 1 09 70 ora #$70 ;Write bit low
|
||||||
|
0010AE 1 48 pha
|
||||||
|
0010AF 1 waitWrite:
|
||||||
|
0010AF 1 AD DE C0 lda InputByte
|
||||||
|
0010B2 1 0A asl ;Second highest bit goes low when ready
|
||||||
|
0010B3 1 30 FA bmi waitWrite
|
||||||
|
0010B5 1 68 pla
|
||||||
|
0010B6 1 8D DD C0 sta OutputByte
|
||||||
|
0010B9 1 finishWrite:
|
||||||
|
0010B9 1 AD DE C0 lda InputByte
|
||||||
|
0010BC 1 0A asl
|
||||||
|
0010BD 1 10 FA bpl finishWrite
|
||||||
|
0010BF 1 60 rts
|
||||||
|
0010C0 1
|
||||||
|
0010C0 1 GetByte:
|
||||||
|
0010C0 1 20 D3 10 jsr GetNibble
|
||||||
|
0010C3 1 0A asl
|
||||||
|
0010C4 1 0A asl
|
||||||
|
0010C5 1 0A asl
|
||||||
|
0010C6 1 0A asl
|
||||||
|
0010C7 1 85 1D sta NibbleStorage
|
||||||
|
0010C9 1 20 D3 10 jsr GetNibble
|
||||||
|
0010CC 1 29 0F and #$0f
|
||||||
|
0010CE 1 05 1D ora NibbleStorage
|
||||||
|
0010D0 1 A5 1D lda NibbleStorage
|
||||||
|
0010D2 1 60 rts
|
||||||
|
0010D3 1
|
||||||
|
0010D3 1 GetNibble:
|
||||||
|
0010D3 1 A9 B0 lda #$b0 ;set read flag low
|
||||||
|
0010D5 1 8D DD C0 sta OutputByte
|
||||||
|
0010D8 1 waitRead:
|
||||||
|
0010D8 1 AD DE C0 lda InputByte
|
||||||
|
0010DB 1 30 FB bmi waitRead
|
||||||
|
0010DD 1 29 F0 and #$f0 ;set all flags high
|
||||||
|
0010DF 1 8D DD C0 sta OutputByte
|
||||||
|
0010E2 1 60 rts
|
||||||
|
0010E3 1
|
||||||
|
0010E3 1
|
||||||
Loading…
Reference in New Issue
Block a user