mirror of https://github.com/mgcaret/of816.git
1170 lines
30 KiB
ArmAsm
1170 lines
30 KiB
ArmAsm
; Platform support library for Neon816
|
|
;
|
|
.include "./Neon816-hw.inc"
|
|
|
|
PLATF_DP = DP_END
|
|
KEYMODS = PLATF_DP ; keyboard modifiers, 16 bits
|
|
; b15 = left shift
|
|
; b14 = right shift
|
|
; b7 = left ctrl
|
|
; b6 = right ctrl
|
|
; these 3 are same position as set LED command:
|
|
; b2 = scroll lock (reserved)
|
|
; b1 = num lock (reserved)
|
|
; b0 = caps lock
|
|
|
|
; Neon816 dictionary, a bit of a different approach than the other ports
|
|
; This will get set up by the post init function of the system interface
|
|
; The system interface functions are after this dictionary.
|
|
|
|
; Note that most of the words are based on words found in NeonFORTH and
|
|
; are not subject to the OF816 license terms, but rather any terms that
|
|
; Lenore Byron places on them.
|
|
|
|
dstart "neon816"
|
|
dchain H_FORTH ; Make branch off the word FORTH
|
|
|
|
dword PS2K_STORE,"PS2K!"
|
|
jsr _popay
|
|
tya
|
|
sep #SHORT_A
|
|
.a8
|
|
sta f:PS2Kio
|
|
: lda f:PS2Kstat
|
|
bit #$08
|
|
bne :-
|
|
rep #SHORT_A
|
|
.a16
|
|
NEXT
|
|
eword
|
|
|
|
dword PS2K_QUERY,"PS2K?"
|
|
ldy #$0000
|
|
sep #SHORT_A
|
|
.a8
|
|
lda f:PS2Kstat
|
|
ror
|
|
rep #SHORT_A
|
|
.a16
|
|
bcc :+
|
|
dey
|
|
: tya
|
|
PUSHNEXT
|
|
eword
|
|
|
|
dword PS2K_FETCH,"PS2K@"
|
|
sep #SHORT_A
|
|
.a8
|
|
: lda f:PS2Kstat
|
|
ror
|
|
bcc :-
|
|
lda f:PS2Kio
|
|
rep #SHORT_A
|
|
.a16
|
|
and #$00FF
|
|
jsr _pusha
|
|
NEXT
|
|
eword
|
|
|
|
dword PS2KEY,"PS2KEY"
|
|
: jsr ps2_keyin
|
|
bcc :-
|
|
jsr _pusha
|
|
NEXT
|
|
eword
|
|
|
|
dword PS2M_STORE,"PS2M!"
|
|
jsr _popay
|
|
tya
|
|
sep #SHORT_A
|
|
.a8
|
|
sta f:PS2Mio
|
|
: lda f:PS2Mstat
|
|
bit #$08
|
|
bne :-
|
|
rep #SHORT_A
|
|
.a16
|
|
NEXT
|
|
eword
|
|
|
|
dword PS2M_QUERY,"PS2M?"
|
|
ldy #$0000
|
|
sep #SHORT_A
|
|
.a8
|
|
lda f:PS2Mstat
|
|
ror
|
|
rep #SHORT_A
|
|
.a16
|
|
bcc :+
|
|
dey
|
|
: tya
|
|
PUSHNEXT
|
|
eword
|
|
|
|
dword PS2M_FETCH,"PS2M@"
|
|
sep #SHORT_A
|
|
.a8
|
|
: lda f:PS2Mstat
|
|
ror
|
|
bcc :-
|
|
lda f:PS2Mio
|
|
rep #SHORT_A
|
|
.a16
|
|
and #$00FF
|
|
jsr _pusha
|
|
NEXT
|
|
eword
|
|
|
|
dword dKBDRESET,"$KBDRESET"
|
|
ENTER
|
|
ONLIT $FF
|
|
.dword PS2K_STORE
|
|
EXIT
|
|
eword
|
|
|
|
; this probably isn't fast enough to reliably set micro and milliseconds
|
|
dword SETRTC,"SETRTC"
|
|
ENTER
|
|
ONLIT RTCus
|
|
.dword WSTORE
|
|
ONLIT RTCms
|
|
.dword WSTORE
|
|
ONLIT RTCsec
|
|
.dword CSTORE
|
|
ONLIT RTCmin
|
|
.dword CSTORE
|
|
ONLIT RTChour
|
|
.dword CSTORE
|
|
ONLIT RTCday
|
|
.dword WSTORE
|
|
EXIT
|
|
eword
|
|
|
|
dword GETRTC,"GETRTC"
|
|
ENTER
|
|
ONLIT RTCday
|
|
.dword WFETCH
|
|
ONLIT RTChour
|
|
.dword CFETCH
|
|
ONLIT RTCmin
|
|
.dword CFETCH
|
|
ONLIT RTCsec
|
|
.dword CFETCH
|
|
ONLIT RTCms
|
|
.dword WFETCH
|
|
ONLIT RTCus
|
|
.dword WFETCH
|
|
EXIT
|
|
eword
|
|
|
|
; NOTE: sets short accumulator and leaves it that way on exit!
|
|
.proc I2C2_busy_wait
|
|
sep #SHORT_A
|
|
nosep:
|
|
.a8
|
|
: lda f:I2C2ctrl
|
|
rol
|
|
bcs :-
|
|
rts
|
|
.a16
|
|
.endproc
|
|
|
|
dword I2C2START,"I2C2START"
|
|
jsr I2C2_busy_wait
|
|
.a8
|
|
lda #$01
|
|
sta f:I2C2ctrl
|
|
rep #SHORT_A
|
|
.a16
|
|
NEXT
|
|
eword
|
|
|
|
dword I2C2STOP,"I2C2STOP"
|
|
jsr I2C2_busy_wait
|
|
.a8
|
|
lda #$02
|
|
sta f:I2C2ctrl
|
|
rep #SHORT_A
|
|
.a16
|
|
NEXT
|
|
eword
|
|
|
|
dword I2C2_STORE,"I2C2!"
|
|
jsr _popay
|
|
jsr I2C2_busy_wait
|
|
.a8
|
|
tya
|
|
sta f:I2C2io
|
|
lda #$08
|
|
sta f:I2C2ctrl
|
|
rep #SHORT_A
|
|
.a16
|
|
NEXT
|
|
eword
|
|
|
|
dword I2C2_FETCH_ACK,"I2C2@+"
|
|
jsr I2C2_busy_wait
|
|
.a8
|
|
lda #$44
|
|
dofetch: sta f:I2C2ctrl
|
|
jsr I2C2_busy_wait::nosep
|
|
lda f:I2C2io
|
|
rep #SHORT_A
|
|
.a16
|
|
and #$00FF
|
|
jsr _pusha
|
|
NEXT
|
|
eword
|
|
|
|
dword I2C2_FETCH,"I2C2@+"
|
|
jsr I2C2_busy_wait
|
|
.a8
|
|
lda #$04
|
|
bra I2C2_FETCH_ACK::dofetch
|
|
.a16
|
|
eword
|
|
|
|
dword VDC_C_STORE,"VDCC!"
|
|
jsr _popay ; pop offset
|
|
phy ; save low word
|
|
jsr _popay ; pop value to write
|
|
pla ; get offset back
|
|
phx ; save SP
|
|
tax ; offset to x reg
|
|
sep #SHORT_A ; whew! that was fun!
|
|
.a8
|
|
tya ; value to A
|
|
sta f:VDCbase,x
|
|
rep #SHORT_A
|
|
.a16
|
|
plx ; restore SP
|
|
NEXT
|
|
eword
|
|
|
|
dword VDC_C_FETCH,"VDCC@"
|
|
jsr _popay ; pop offet
|
|
phx ; save SP
|
|
tya
|
|
tax
|
|
sep #SHORT_A ; whew! that was fun!
|
|
.a8
|
|
lda f:VDCbase,x
|
|
rep #SHORT_A
|
|
.a16
|
|
plx ; restore SP
|
|
and #$00FF
|
|
jsr _pusha
|
|
NEXT
|
|
eword
|
|
|
|
dword VDC_STORE,"VDC!"
|
|
jsr _popay ; again! again! again!
|
|
phy
|
|
jsr _popay
|
|
pla
|
|
phx
|
|
tax
|
|
tya
|
|
sta f:VDCbase,x
|
|
rep #SHORT_A
|
|
.a16
|
|
plx ; restore SP
|
|
NEXT
|
|
eword
|
|
|
|
dword VIDSTART,"VIDSTART"
|
|
ENTER
|
|
ONLIT $0799
|
|
ONLIT $10
|
|
.dword VDC_STORE
|
|
ONLIT $0839
|
|
ONLIT $12
|
|
.dword VDC_STORE
|
|
ONLIT $03C7
|
|
ONLIT $14
|
|
.dword VDC_STORE
|
|
ONLIT $041E
|
|
ONLIT $16
|
|
.dword VDC_STORE
|
|
ONLIT $0257
|
|
ONLIT $18
|
|
.dword VDC_STORE
|
|
ONLIT $0258
|
|
ONLIT $1A
|
|
.dword VDC_STORE
|
|
ONLIT $025C
|
|
ONLIT $1C
|
|
.dword VDC_STORE
|
|
ONLIT $0272
|
|
ONLIT $1E
|
|
.dword VDC_STORE
|
|
vid_on: ONLIT $92
|
|
: .dword ZERO
|
|
.dword VDC_C_STORE
|
|
.dword ZERO
|
|
.dword VDC_C_FETCH
|
|
.dword IF
|
|
.dword :- ; branch if false
|
|
.dword I2C2START
|
|
ONLIT $70
|
|
.dword I2C2_STORE
|
|
ONLIT $08
|
|
.dword I2C2_STORE
|
|
ONLIT $B9
|
|
.dword I2C2_STORE
|
|
.dword I2C2STOP
|
|
EXIT
|
|
eword
|
|
|
|
dword VMODELINE,"VMODELINE"
|
|
ENTER
|
|
.dword TWO
|
|
.dword MINUS
|
|
ONLIT $1E
|
|
.dword VDC_STORE
|
|
.dword DECR
|
|
ONLIT $1C
|
|
.dword VDC_STORE
|
|
.dword DECR
|
|
ONLIT $1A
|
|
.dword VDC_STORE
|
|
.dword DECR
|
|
ONLIT $18
|
|
.dword VDC_STORE
|
|
.dword TWO
|
|
.dword MINUS
|
|
ONLIT $16
|
|
.dword VDC_STORE
|
|
.dword DECR
|
|
ONLIT $14
|
|
.dword VDC_STORE
|
|
.dword DECR
|
|
ONLIT $12
|
|
.dword VDC_STORE
|
|
.dword DECR
|
|
ONLIT $10
|
|
.dword VDC_STORE
|
|
JUMP VIDSTART::vid_on
|
|
eword
|
|
|
|
dword VIDSTOP,"VIDSTOP"
|
|
ENTER
|
|
.dword I2C2START
|
|
ONLIT $70
|
|
.dword I2C2_STORE
|
|
ONLIT $08
|
|
.dword I2C2_STORE
|
|
ONLIT $FE
|
|
.dword I2C2_STORE
|
|
.dword I2C2STOP
|
|
.dword ZERO
|
|
.dword ZERO
|
|
.dword VDC_C_STORE
|
|
EXIT
|
|
eword
|
|
|
|
dword DUMPEDID,"DUMPEDID"
|
|
dump_size = $0100
|
|
ENTER
|
|
ONLIT dump_size
|
|
.dword ALLOC ; buffer for downloaded EDID data
|
|
.dword I2C2START
|
|
ONLIT $A0
|
|
.dword I2C2_STORE
|
|
.dword ZERO
|
|
.dword I2C2_STORE
|
|
.dword I2C2START
|
|
ONLIT $A1
|
|
.dword I2C2_STORE
|
|
ONLIT dump_size
|
|
.dword ZERO
|
|
.dword _DO
|
|
: .dword I2C2_FETCH_ACK
|
|
.dword OVER
|
|
.dword IX
|
|
.dword PLUS
|
|
.dword CSTORE
|
|
.dword ONE
|
|
.dword _PLOOP
|
|
.dword :-
|
|
.dword UNLOOP
|
|
.dword I2C2_FETCH ; NeonFORTH displays this
|
|
.dword I2C2STOP
|
|
.dword DUP
|
|
ONLIT dump_size
|
|
.dword DUMP
|
|
ONLIT dump_size
|
|
.dword FREE
|
|
EXIT
|
|
eword
|
|
|
|
dword SPI2INIT,"SPI2INIT"
|
|
sep #SHORT_A
|
|
.a8
|
|
lda #$00
|
|
sta f:SPI2ctrl
|
|
sta f:SPI2ctrl2
|
|
lda #$05
|
|
sta f:SPI2ctrl3
|
|
rep #SHORT_A
|
|
.a16
|
|
NEXT
|
|
eword
|
|
|
|
dword SPI2START,"SPI2START"
|
|
sep #SHORT_A
|
|
.a8
|
|
lda #$01
|
|
sta f:SPI2ctrl
|
|
rep #SHORT_A
|
|
.a16
|
|
NEXT
|
|
eword
|
|
|
|
dword SPI2STOP,"SPI2STOP"
|
|
sep #SHORT_A
|
|
.a8
|
|
: lda f:SPI2ctrl
|
|
and #$40
|
|
bne :-
|
|
sta f:SPI2ctrl ; note A=0
|
|
rep #SHORT_A
|
|
.a16
|
|
NEXT
|
|
eword
|
|
|
|
; NOTE: sets short accumulator and leaves it that way on exit!
|
|
.proc SPI2_busy_wait
|
|
sep #SHORT_A
|
|
nosep:
|
|
.a8
|
|
: lda f:SPI2ctrl
|
|
rol
|
|
bcs :-
|
|
rts
|
|
.a16
|
|
.endproc
|
|
|
|
dword SPI2_STORE,"SPI2!"
|
|
jsr _popay
|
|
jsr SPI2_busy_wait
|
|
.a8
|
|
tya
|
|
sta f:SPI2io
|
|
rep #SHORT_A
|
|
.a16
|
|
NEXT
|
|
eword
|
|
|
|
dword SPI2_FETCH,"SPI2@"
|
|
jsr SPI2_busy_wait
|
|
.a8
|
|
lda #$00
|
|
sta f:SPI2io
|
|
: lda f:SPI2ctrl
|
|
bit #$40
|
|
bne :-
|
|
lda f:SPI2io
|
|
rep #SHORT_A
|
|
.a16
|
|
and #$00FF
|
|
jsr _pusha
|
|
NEXT
|
|
eword
|
|
|
|
dend
|
|
|
|
; and now for the system interface
|
|
|
|
.proc _system_interface
|
|
;wdm 3
|
|
phx
|
|
asl
|
|
tax
|
|
jmp (.loword(table),x)
|
|
table: .addr _sf_pre_init
|
|
.addr _sf_post_init
|
|
.addr _sf_emit
|
|
.addr _sf_keyq
|
|
.addr _sf_key
|
|
.addr _sf_fcode
|
|
.addr _sf_reset_all
|
|
.endproc
|
|
.export _system_interface
|
|
|
|
.proc _sf_success
|
|
lda #$0000
|
|
tay
|
|
clc
|
|
rtl
|
|
.endproc
|
|
|
|
.proc _sf_fail
|
|
ldy #.loword(-21)
|
|
lda #.hiword(-21)
|
|
sec
|
|
rtl
|
|
.endproc
|
|
|
|
|
|
.proc _sf_pre_init
|
|
; NeonFORTH does this, presumably to initialize the serial port
|
|
; The code from here to the EOC commment was adapted from code written by Lenore Byron
|
|
sep #SHORT_A
|
|
.a8
|
|
lda #$8D
|
|
sta f:SERctrlA
|
|
lda #$06
|
|
sta f:SERctrlB
|
|
lda #$00
|
|
sta f:SERctrlC
|
|
rep #SHORT_A
|
|
.a16
|
|
; EOC
|
|
plx
|
|
jmp _sf_success
|
|
.endproc
|
|
|
|
.proc _sf_post_init
|
|
plx
|
|
; Here we make a vocabulary definition for the neon816 dictionary
|
|
; that we defined at the beginning of this file.
|
|
ENTER
|
|
ONLIT LAST_neon816
|
|
SLIT "NEON816"
|
|
.dword dVOCAB
|
|
.dword LAST ; now set the head of the vocabulary to the
|
|
.dword drXT ; last word defined in the neon816 dictionary
|
|
.dword rBODY
|
|
.dword STORE
|
|
.dword GETRTC ; start the clock
|
|
.dword CLEAR
|
|
CODE
|
|
jmp _sf_success
|
|
.endproc
|
|
|
|
.proc _sf_emit
|
|
plx ; get forth SP
|
|
jsr _popay ; grab the top item
|
|
phx ; and save new SP
|
|
; The code from here to the EOC commment was adapted from code written by Lenore Byron
|
|
sep #SHORT_A
|
|
.a8
|
|
tya
|
|
sta f:SERio
|
|
: lda f:SERstat
|
|
bit #$08
|
|
bne :-
|
|
rep #SHORT_A
|
|
.a16
|
|
; EOC
|
|
plx
|
|
jmp _sf_success
|
|
.endproc
|
|
|
|
.proc _sf_keyq
|
|
ldy #$0000 ; anticipate false
|
|
; The code from here to the EOC commment was adapted from code written by Lenore Byron
|
|
sep #SHORT_A
|
|
.a8
|
|
lda f:SERstat ; b0=1 if data ready
|
|
ror
|
|
bcc :+
|
|
iny
|
|
: rep #SHORT_A
|
|
.a16
|
|
; EOC
|
|
tya
|
|
plx
|
|
jsr _pushay
|
|
jmp _sf_success
|
|
.endproc
|
|
|
|
.proc _sf_key
|
|
; The code from here to the EOC commment was adapted from code written by Lenore Byron
|
|
sep #SHORT_A
|
|
.a8
|
|
: lda f:SERstat
|
|
ror
|
|
bcc :-
|
|
lda f:SERio
|
|
rep #SHORT_A
|
|
.a16
|
|
; EOC
|
|
and #$00FF
|
|
tay
|
|
lda #$0000
|
|
plx
|
|
jsr _pushay
|
|
jmp _sf_success
|
|
.endproc
|
|
|
|
.proc _sf_fcode
|
|
.if include_fcode
|
|
ldy #.loword(list)
|
|
lda #.hiword(list)
|
|
.else
|
|
lda #$0000
|
|
tay
|
|
.endif
|
|
plx
|
|
jsr _pushay
|
|
jmp _sf_success
|
|
.if include_fcode
|
|
list:
|
|
.dword 0
|
|
.endif
|
|
.endproc
|
|
|
|
; TODO....
|
|
.proc _sf_reset_all
|
|
plx
|
|
jmp _sf_fail
|
|
.endproc
|
|
|
|
; return carry set if data waiting at PS/2 keyboard port, clear otherwise
|
|
; destroys A
|
|
.proc ps2k_ready
|
|
sep #SHORT_A
|
|
.a8
|
|
lda f:PS2Kstat
|
|
ror
|
|
rep #SHORT_A
|
|
.a16
|
|
rts
|
|
.endproc
|
|
|
|
; read data from PS/2 keyboard port, blocking
|
|
; returns byte in A
|
|
.proc ps2k_read
|
|
sep #SHORT_A
|
|
.a8
|
|
: lda f:PS2Kstat
|
|
ror
|
|
bcc :-
|
|
lda f:PS2Kio
|
|
rep #SHORT_A
|
|
.a16
|
|
and #$00FF
|
|
rts
|
|
.endproc
|
|
|
|
; write data byte in A to PS/2 keyboard port
|
|
.proc ps2k_write
|
|
sep #SHORT_A
|
|
.a8
|
|
sta f:PS2Kio
|
|
: lda f:PS2Kstat
|
|
bit #$08
|
|
bne :-
|
|
rep #SHORT_A
|
|
.a16
|
|
rts
|
|
.endproc
|
|
|
|
; Keyboard translate tables
|
|
; unshifted and shifted codes
|
|
; if high bit set, jump to special handler routine
|
|
|
|
.proc mktab ; 'main' scan codes'
|
|
; $00
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; F9
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; F5
|
|
.byte $00,$00 ; F3
|
|
.byte $00,$00 ; F1
|
|
.byte $00,$00 ; F2
|
|
.byte $00,$00 ; F12
|
|
; $08
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; F10
|
|
.byte $00,$00 ; F8
|
|
.byte $00,$00 ; F6
|
|
.byte $00,$00 ; F4
|
|
.byte $09,$09 ; Tab
|
|
.byte '`','~'
|
|
.byte $00,$00 ; none
|
|
; $10
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; left alt
|
|
.byte $80,$80 ; left shift
|
|
.byte $00,$00 ; none
|
|
.byte $86,$86 ; left control
|
|
.byte 'q','Q'
|
|
.byte '1','!'
|
|
.byte $00,$00 ; none
|
|
; $18
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte 'z','Z'
|
|
.byte 's','S'
|
|
.byte 'a','A'
|
|
.byte 'w','W'
|
|
.byte '2','@'
|
|
.byte $00,$00 ; none
|
|
; $20
|
|
.byte $00,$00 ; none
|
|
.byte 'c','C'
|
|
.byte 'x','X'
|
|
.byte 'd','D'
|
|
.byte 'e','E'
|
|
.byte '4','$'
|
|
.byte '3','#'
|
|
.byte $00,$00 ; none
|
|
; $28
|
|
.byte $00,$00 ; none
|
|
.byte ' ',' '
|
|
.byte 'v','V'
|
|
.byte 'f','F'
|
|
.byte 't','T'
|
|
.byte 'r','R'
|
|
.byte '5','S'
|
|
.byte $00,$00 ; none
|
|
; $30
|
|
.byte $00,$00 ; none
|
|
.byte 'n','N'
|
|
.byte 'b','B'
|
|
.byte 'h','H'
|
|
.byte 'g','G'
|
|
.byte 'y','Y'
|
|
.byte '6','^'
|
|
.byte $00,$00 ; none
|
|
; $38
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte 'm','M'
|
|
.byte 'j','J'
|
|
.byte 'u','U'
|
|
.byte '7','&'
|
|
.byte '8','*'
|
|
.byte $00,$00 ; none
|
|
; $40
|
|
.byte $00,$00 ; none
|
|
.byte ',','<'
|
|
.byte 'k','K'
|
|
.byte 'i','I'
|
|
.byte 'o','O'
|
|
.byte '0',')'
|
|
.byte '9','('
|
|
.byte $00,$00 ; none
|
|
; $48
|
|
.byte $00,$00 ; none
|
|
.byte '.','>'
|
|
.byte '/','?'
|
|
.byte 'l','L'
|
|
.byte ';',':'
|
|
.byte 'p','P'
|
|
.byte '-','_'
|
|
.byte $00,$00 ; none
|
|
; $50
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $27,'"'
|
|
.byte $00,$00 ; none
|
|
.byte '[','{'
|
|
.byte '=','+'
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $58
|
|
.byte $00,$00 ; none
|
|
.byte $84,$84 ; caps lock
|
|
.byte $82,$82 ; right shift
|
|
.byte $0D,$0D ; enter
|
|
.byte ']','}'
|
|
.byte $00,$00 ; none
|
|
.byte '\','|'
|
|
.byte $00,$00 ; none
|
|
; $60
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $08,$7F ; backspace
|
|
.byte $00,$00 ; none
|
|
; $68
|
|
.byte $00,$00 ; none
|
|
.byte '1','1' ; keypad
|
|
.byte $00,$00 ; none
|
|
.byte '4','4' ; keypad
|
|
.byte '7','7' ; keypad
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $70
|
|
.byte '0','0' ; keypad
|
|
.byte '.','.' ; keypad
|
|
.byte '2','2' ; keypad
|
|
.byte '5','5' ; keypad
|
|
.byte '6','6' ; keypad
|
|
.byte '8','8' ; keypad
|
|
.byte $1B,$1B ; escape
|
|
.byte $00,$00 ; num lock
|
|
; $78
|
|
.byte $00,$00 ; F11
|
|
.byte '+','+' ; keypad
|
|
.byte '3','3' ; keypad
|
|
.byte '-','-' ; keypad
|
|
.byte '*','*' ; keypad
|
|
.byte '9','9' ; keypad
|
|
.byte $00,$00 ; scroll lock
|
|
.byte $00,$00 ; none
|
|
; $80
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; F7
|
|
.endproc
|
|
|
|
.proc ektab ; E0 scan codes
|
|
; $00
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $08
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $10
|
|
.byte $00,$00 ; MM WWW search
|
|
.byte $00,$00 ; right alt
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $88,$88 ; right control
|
|
.byte $00,$00 ; MM prev track
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $18
|
|
.byte $00,$00 ; MM WWW favorites
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; left GUI
|
|
; $20
|
|
.byte $00,$00 ; MM WWW refresh
|
|
.byte $00,$00 ; MM vol down
|
|
.byte $00,$00 ; MM mute
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; right GUI
|
|
; $28
|
|
.byte $00,$00 ; MM WWW stop
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; MM calculator
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; 'apps'
|
|
; $30
|
|
.byte $00,$00 ; MM WWW forward
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; MM vol up
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; MM play/pause
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; ACPI power
|
|
; $38
|
|
.byte $00,$00 ; MM WWW back
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; MM WWW home
|
|
.byte $00,$00 ; MM stop
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; ACPI sleep
|
|
; $40
|
|
.byte $00,$00 ; MM my computer
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $48
|
|
.byte $00,$00 ; MM email
|
|
.byte $00,$00 ; none
|
|
.byte '/','/' ; keypad
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; MM next track
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $50
|
|
.byte $00,$00 ; MM select
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $58
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $0D,$0D ; keypad 'enter'
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; ACPI wake
|
|
.byte $00,$00 ; none
|
|
; $60
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $68
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; end
|
|
.byte $00,$00 ; none
|
|
.byte $08,$08 ; cursor left
|
|
.byte $00,$00 ; home
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $70
|
|
.byte $00,$00 ; insert
|
|
.byte $7F,$7F ; delete
|
|
.byte $0A,$0A ; cursor down
|
|
.byte $00,$00 ; none
|
|
.byte $15,$15 ; cursor right
|
|
.byte $0B,$0B ; cursor up
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
; $78
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; page down
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; none
|
|
.byte $00,$00 ; page up
|
|
.endproc
|
|
|
|
; Tables of routines for special make/break of keys (values > $80)
|
|
; kmktbl and kbktbl must match up.
|
|
.proc kmktbl
|
|
.addr mk_lshift-1 ; $80
|
|
.addr mk_rshift-1 ; $82
|
|
.addr mk_caps-1 ; $84
|
|
.addr mk_lctrl-1 ; $86
|
|
.addr mk_rctrl-1 ; $88
|
|
.endproc
|
|
|
|
.proc kbktbl
|
|
.addr bk_lshift-1 ; $80
|
|
.addr bk_rshift-1 ; $82
|
|
.addr bk_caps-1 ; $84
|
|
.addr bk_lctrl-1 ; $88
|
|
.addr bk_rctrl-1 ; $88
|
|
.endproc
|
|
|
|
.proc mk_lshift
|
|
lda #%1000000000000000
|
|
bra makemod
|
|
.endproc
|
|
|
|
.proc mk_rshift
|
|
lda #%0100000000000000
|
|
bra makemod
|
|
.endproc
|
|
|
|
.proc mk_caps
|
|
lda #%0000000000000001
|
|
jsr makemod
|
|
; fall-through to ps2_setLEDs
|
|
.endproc
|
|
|
|
.proc ps2_setleds
|
|
lda #$ED ; set LEDs command
|
|
jsr ps2k_write
|
|
lda KEYMODS
|
|
jsr ps2k_write
|
|
bra nokey
|
|
.endproc
|
|
|
|
.proc mk_lctrl
|
|
lda #%0000000010000000
|
|
bra makemod
|
|
.endproc
|
|
|
|
.proc mk_rctrl
|
|
lda #%0000000001000000
|
|
;bra makemod
|
|
.endproc
|
|
|
|
.proc makemod
|
|
tsb KEYMODS
|
|
; fall through to nokey
|
|
.endproc
|
|
|
|
.proc nokey
|
|
lda #$0000
|
|
clc
|
|
rts
|
|
.endproc
|
|
|
|
.proc bk_lshift
|
|
lda #%1000000000000000
|
|
bra breakmod
|
|
.endproc
|
|
|
|
.proc bk_rshift
|
|
lda #%0100000000000000
|
|
bra breakmod
|
|
.endproc
|
|
|
|
.proc bk_caps
|
|
lda #%0000000000000001
|
|
jsr breakmod
|
|
bra ps2_setleds
|
|
.endproc
|
|
|
|
.proc bk_lctrl
|
|
lda #%0000000010000000
|
|
bra breakmod
|
|
.endproc
|
|
|
|
.proc bk_rctrl
|
|
lda #%0000000001000000
|
|
;bra breakmod
|
|
.endproc
|
|
|
|
.proc breakmod
|
|
trb KEYMODS
|
|
bra nokey
|
|
.endproc
|
|
|
|
; expects a 'make' code, either 00xx or E0xx
|
|
.proc ps2_keydn
|
|
lda #%1100000000000000 ; shift keys
|
|
bit KEYMODS
|
|
php ; save result (Z=1 if no shift)
|
|
ora #$0000 ; if high bit is set we will treat as $E0
|
|
php
|
|
and #$00FF
|
|
asl
|
|
tay
|
|
lda #$0000 ; anticipate failure of cpy
|
|
plp
|
|
bmi :+
|
|
cpy .sizeof(mktab)/2
|
|
bcs :++ ; bad value
|
|
lda mktab,y
|
|
bra :++
|
|
: cpy .sizeof(ektab)/2
|
|
bcs :+ ; bad value
|
|
lda ektab,y
|
|
: plp
|
|
beq :+ ; unshifted
|
|
xba
|
|
: and #$00FF
|
|
cmp #$0080
|
|
bcs special
|
|
pha
|
|
lda KEYMODS
|
|
ror ; caps lock into carry
|
|
pla
|
|
bcc nocaps ; if no caps lock
|
|
cmp #'a'
|
|
bcc nocaps
|
|
cmp #'z'+1
|
|
bcs nocaps
|
|
and #$DF ; make caps
|
|
nocaps: pha ; save on stack
|
|
lda #%0000000011000000 ; ctrl keys
|
|
bit KEYMODS
|
|
beq :+ ; if no ctrl
|
|
lda 1,s
|
|
and #%0000000000011111 ; make ctrl
|
|
sta 1,s
|
|
: pla
|
|
cmp #$01 ; set carry if >= 1
|
|
rts
|
|
special: and #$7f
|
|
tay
|
|
lda kmktbl,y
|
|
pha
|
|
rts
|
|
.endproc
|
|
|
|
; for the break we only care about modifiers, we aren't keeping track of anything else
|
|
; so we also ignore shifted values
|
|
; expects a 'make'-like code, either 00xx or E0xx
|
|
.proc ps2_keyup
|
|
ora #$0000
|
|
php
|
|
and #$00FF
|
|
asl
|
|
tay
|
|
plp
|
|
bmi :+
|
|
cpy .sizeof(mktab)/2
|
|
bcs :++
|
|
lda mktab,y
|
|
bra :++
|
|
: cpy .sizeof(ektab)/2
|
|
bcs :+
|
|
lda ektab,y
|
|
: and #$00FF
|
|
cmp #$0080
|
|
bcs special
|
|
lda #$0000
|
|
clc
|
|
rts
|
|
special: and #$7f
|
|
tay
|
|
lda kbktbl,y
|
|
pha
|
|
rts
|
|
.endproc
|
|
|
|
; Wait for a valid key, when we get one, decode and return
|
|
.proc ps2_keyin
|
|
: jsr ps2k_read
|
|
cmp #$F0
|
|
beq break
|
|
cmp #$FE
|
|
beq extended
|
|
cmp #$AA ; diags passed
|
|
beq :-
|
|
cmp #$FC ; diags failed
|
|
beq :- ; prob shouldn't do this
|
|
cmp #$FA ; ACK
|
|
beq :-
|
|
jmp ps2_keydn ; see if we can decode it
|
|
break: jsr ps2k_read
|
|
bra ps2_keyup
|
|
extended: jsr ps2k_read
|
|
cmp #$F0
|
|
beq :+ ; extended break
|
|
ora #$E000
|
|
jmp ps2_keydn
|
|
: jsr ps2k_read
|
|
ora #$E000
|
|
bra ps2_keyup
|
|
.endproc
|
|
|