MatthiasQuintern/6502-OS
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

send commands working

Browse Source
This commit is contained in:
matthias@arch 2024-01-07 00:42:05 +01:00
parent 23e5e3cd35
commit e8696cc312
1 changed files with 165 additions and 46 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

211
system/ps2_keyboard.s65
View File

@ -2,22 +2,26 @@
.include "string.h65" .include "string.h65"
.include "lcd.h65" .include "lcd.h65"
.include "parity.h65" .include "parity.h65"
Export ps2kb,init,begin_receive,send_command,scancode,status,scancode_handler Export ps2kb, init, begin_receive, scancode, status, scancode_handler
Export ps2kb, _receive_irq_shift_reg_handler, _receive_irq_timer_handler, _send_byte, _send_irq_shift_reg_handler, _send_irq_timer_handler, Export ps2kb, _receive_irq_shift_reg_handler, _receive_irq_timer_handler, _send_byte, _send_irq_shift_reg_handler, _send_irq_timer_handler,
Export ps2kb, send_last_bits, send_cmd, send_data, key_read, prev_status Export ps2kb, send_command, send_cmd, send_data, cmd_response, response_length, FMT_CMD_FAIL
.bss .bss
status: .res 1 status: .res 1 ; current status
prev_status: .res 1 prev_status: .res 1 ; status before sending command
send_last_bits: .res 1 send_last_bits: .res 1 ; last bits to load after 8 bits were shifted out
send_data: .res 1 send_cmd: .res 1 ; command to send/last sent
send_cmd: .res 1 send_data: .res 1 ; data byte to send/last sent or NO_DATA
key_read: .res 2 expect_data_length: .res 1 ; number of data bytes to expect from keyboard
scancode: .res 1 response_length: .res 1 ; number of response bytes from keyboard
scancode_handler: .res 2 cmd_response: .res 3 ; responses from keyboard
key_read: .res 2 ; first 8 bits, last 3 bits from scancode
scancode: .res 1 ; last received scancode
scancode_handler: .res 2 ; pointer to a function that handles new scancodes
.code .code
; these are macros the save time during the interrupt handler (no jsr, rts)
;;******************************************************************************** ;;********************************************************************************
;; @macro Enable the clock signal from the keyboard ;; @macro Enable the clock signal from the keyboard
;; @modifies: A ;; @modifies: A
@ -113,13 +117,14 @@ scancode_handler: .res 2
stz key_read stz key_read
stz key_read+1 stz key_read+1
stz scancode stz scancode
bit status
; the 3 last bits take about 230us, at @1MHz => wait 230 cycles and then the shift register ; the 3 last bits take about 230us, at @1MHz => wait 230 cycles and then the shift register
; (this could be shorter since the it takes a few cycles after the interrupt) ; (this could be shorter since the it takes a few cycles after the interrupt)
lda #<ps2kb::TIMER_RECV lda #<ps2kb::TIMER_RECV
sta ps2kb::VIA + IO::T2CL sta ps2kb::VIA + IO::T2CL
; set to RECEIVE_KEYS only if RECEIVE_ANSWER is not set ; set to RECEIVE_KEYS only if RECEIVE_ANSWER is not set
bit status
bvs @status_set bvs @status_set
lda #ps2kb::STATUS::RECEIVE_KEYS lda #ps2kb::STATUS::RECEIVE_KEYS
sta status sta status
@ -157,7 +162,7 @@ scancode_handler: .res 2
IO_DisableIRQ ps2kb::VIA, IO::IRQ::SR IO_DisableIRQ ps2kb::VIA, IO::IRQ::SR
IO_EnableIRQ ps2kb::VIA, IO::IRQ::T2 IO_EnableIRQ ps2kb::VIA, IO::IRQ::T2
; start timer, low order count already in latch after init ; start timer, low order count already in latch after begin_receive
lda #>ps2kb::TIMER_RECV lda #>ps2kb::TIMER_RECV
sta ps2kb::VIA + IO::T2CH sta ps2kb::VIA + IO::T2CH
rts rts
@ -201,41 +206,68 @@ scancode_handler: .res 2
sta scancode sta scancode
; check parity ; check parity
; CalculateOddParity CalculateOddParity
; eor key_read+1 ; if bit 0 is 1 - parity error eor key_read+1 ; if bit 0 is 1 - parity error
; and #1 ; bit 1 is still D7 and #1 ; bit 1 is still D7
; bne @parity_error bne @parity_error
@handle_scancode:
; check what to do with the scancode ; check what to do with the scancode
bit status bit status
bcc @status_not_receive_keys bpl @status_not_receive_keys ; RECEIVE_KEYS
jmp (scancode_handler) jmp (scancode_handler)
@status_not_receive_keys: @status_not_receive_keys:
bvc @status_ignore bvc @status_dont_handle ; RECEIVE_ANSWER
jmp _process_cmd_answer jmp _process_cmd_answer
@status_ignore: @status_dont_handle:
rts rts
@parity_error: ; TODO handle somehow @parity_error: ; TODO handle somehow
lda #$ff lda #$fe ; fe means error/resend for commands
sta scancode sta scancode
DEBUG_LED_ON 2 DEBUG_LED_ON 2
rts bra @handle_scancode
.endproc .endproc
;;******************************************************************************** ;;********************************************************************************
;; @function Send a command to the keyboard ;; @function Send a command to the keyboard
;; @details
;; No checks are done on the validity of the command and data byte.
;; You can send anything you want to the keyboard.
;; `send_command` will return immediately, as sending the command is asynchronous.
;; The command is done if `ps2kb::status & ps2kb::STATUS::SEND == 0`.
;; @section Response
;; The answers will be in the byte array ps2kb::cmd_response.
;; If the command did not have a data byte, cmd_response is:
;; - 0: command response
;; - 1: NO_RESPONSE or additional response byte (identify keyboard command only)
;; - 2: NO_RESPONSE or additional response byte (identify keyboard command only)
;; If the command did have a data byte, cmd_response is:
;; - 0: 0xFA (ACK) or 0xFE (Resend/Error)
;; - 1: 0xFA (ACK) or 0xFE (Resend/Error)
;; - 2: NO_RESPONSE or additional response byte
;;
;; If ANY of the bytes in cmd_response is 0xFE, the command failed.
;;
;; @modifies: A,X,Y ;; @modifies: A,X,Y
;; @param A: The command byte ;; @param A: The command byte
;; @param X: The data byte or NO_DATA if only the command byte should be sent ;; @param X: The data byte or NO_DATA if only the command byte should be sent
;; @param Y: The number of data bytes expected to receive. Must be one of {0, 1, 2}
;;******************************************************************************** ;;********************************************************************************
.proc send_command .proc send_command
sty expect_data_length
stx send_data
stz response_length
ldy #ps2kb::NO_RESPONSE
sty cmd_response
sty cmd_response+1
sty cmd_response+2
ldy status ldy status
sty prev_status sty prev_status
ldy #ps2kb::STATUS::SEND_CMD ldy #ps2kb::STATUS::SEND_CMD
sty status sty status
sta send_cmd ; store if it needs to be resent sta send_cmd ; store if it needs to be resent
stx send_data
jmp _send_byte jmp _send_byte
.endproc .endproc
@ -278,8 +310,9 @@ scancode_handler: .res 2
lda #<ps2kb::TIMER_SEND lda #<ps2kb::TIMER_SEND
sta ps2kb::VIA + IO::T2CL sta ps2kb::VIA + IO::T2CL
; setup interrupt handlers
StoreDByte _send_irq_shift_reg_handler, $3000 StoreDByte _send_irq_shift_reg_handler, $3000
StoreDByte _send_irq_timer_handler, $3006 StoreDByte _send_irq_timer_handler, $3060
pla pla
Reverse A Reverse A
pha pha
@ -287,7 +320,7 @@ scancode_handler: .res 2
ror ; Parity -> C ror ; Parity -> C
lda #$ff lda #$ff
ror ; Parity -> bit 7, rest = 1 ror ; Parity -> bit 7, rest = 1
sta ps2kb::send_last_bits ; loaded into SR by irq handler sta send_last_bits ; loaded into SR by irq handler
pla pla
sta ps2kb::VIA + IO::SR sta ps2kb::VIA + IO::SR
IO_EnableIRQ ps2kb::VIA, IO::IRQ::SR IO_EnableIRQ ps2kb::VIA, IO::IRQ::SR
@ -306,7 +339,7 @@ scancode_handler: .res 2
;; - start timer 2 ;; - start timer 2
;;******************************************************************************** ;;********************************************************************************
.proc _send_irq_shift_reg_handler .proc _send_irq_shift_reg_handler
lda ps2kb::send_last_bits lda send_last_bits
sta ps2kb::VIA + IO::SR sta ps2kb::VIA + IO::SR
IO_DisableIRQ ps2kb::VIA, IO::IRQ::SR IO_DisableIRQ ps2kb::VIA, IO::IRQ::SR
@ -319,34 +352,120 @@ scancode_handler: .res 2
;;******************************************************************************** ;;********************************************************************************
;; @function Send databyte or reveice the keyboards answer ;; @function Setup VIA to receive the keyboard's answer
;; @modifies: A, X, Y ;; @modifies: A
;; @details ;; @details
;; - disable timer 2 interrupts ;; - disable timer 2 interrupts
;; - if send_data is zero: ;; - pull clock low
;; - begin_receive ;; - or status with RECEIVE_ANSWER
;; - set status RECEIVE_ANSWER ;; - begin receive
;; - else
;; - send_byte send_data
;; - set send_data = 0
;;******************************************************************************** ;;********************************************************************************
.proc _send_irq_timer_handler .proc _send_irq_timer_handler
lda ps2kb::VIA + IO::T2CL ; clear interrupt flag lda ps2kb::VIA + IO::T2CL ; clear interrupt flag
IO_DisableIRQ ps2kb::VIA, IO::IRQ::T2 IO_DisableIRQ ps2kb::VIA, IO::IRQ::T2
lda ps2kb::send_data ; disable shift register
beq @receive lda ps2kb::VIA + IO::ACR
stz ps2kb::send_data and #<~IO::ACR_MASK::SR
jmp _send_byte sta ps2kb::VIA + IO::ACR
rts
@receive: _DisableClock ; disable keyboard while setting up receive
_DisableClock ; disable keyboard while setting up receive lda status
lda #ps2kb::STATUS::RECEIVE_ANSWER ora #ps2kb::STATUS::RECEIVE_ANSWER
sta ps2kb::status sta status
jmp ps2kb::begin_receive jmp ps2kb::begin_receive
.endproc .endproc
.proc _process_cmd_answer ;;********************************************************************************
jmp ($3200) ;; @function Process the response of a command
;; @details
;; Stores the answer in the `ps2kb::cmd_response` array.
;; If the response is $FE or command related transmissions are done (see below),
;; no further data will be sent or received and the `ps2kb::status` takes the previous value.
;;
;; - store response
;; - if response == 0xFE -> stop
;; - if status == SEND_CMD -> send databyte
;; - if statusk
;; You can send anything you want to the keyboard.
;; `send_command` will return immediately, as sending the command is asynchronous.
;; The command is done if `ps2kb::status & ps2kb::STATUS::SEND == 0`.
;; @section Response
;; The answers will be in the byte array ps2kb::cmd_response.
;; If the command did not have a data byte, cmd_response is:
;; - 0: command response
;; - 1: NO_RESPONSE or additional response byte (identify keyboard command only)
;; - 2: NO_RESPONSE or additional response byte (identify keyboard command only)
;; If the command did have a data byte, cmd_response is:
;; - 0: 0xFA (ACK) or 0xFE (Resend/Error)
;; - 1: 0xFA (ACK) or 0xFE (Resend/Error)
;; - 2: NO_RESPONSE or additional response byte
;;
;; If ANY of the bytes in cmd_response is 0xFE, the command failed.
;;
;; @modifies: A,X,Y
;; @param A: The command byte
;; @param X: The data byte or NO_DATA if only the command byte should be sent
;; @param Y: The number of data bytes expected to receive. Must be one of {0, 1, 2}
;;********************************************************************************
.proc _process_cmd_answer
@store_response:
ldx response_length
lda scancode
sta cmd_response,x
inx
stx response_length
stz scancode
; check for resend
cmp #$fe
beq @cmd_fail
; received something useful, check state
lda status
bit #ps2kb::STATUS::SEND_CMD
bne @cmd_sent
bit #ps2kb::STATUS::SEND_DATA
bne @everything_sent
; status must be SEND_RECV
@receive_data_response:
dec expect_data_length
bmi @cmd_done ; no more expected data
rts ; wait for another data byte
@cmd_sent:
; check if a data byte needs to be sent
lda send_data
beq @send_data ; if 0 (would fall through the cmp check TODO would it??)
cmp #ps2kb::NO_DATA
beq @everything_sent ; if not NO_DATA
@send_data:
lda #ps2kb::STATUS::SEND_DATA
sta status
lda send_data
jmp ps2kb::_send_byte ; send the data
@everything_sent: ; check if additonal bytes are expected
dec expect_data_length
bmi @cmd_done ; expect_data_length was 0
lda #(ps2kb::STATUS::SEND_RECV | ps2kb::STATUS::RECEIVE_ANSWER)
sta status
rts
@cmd_fail: ; keyboard wont expect data byte/send an additional response byte
@cmd_done:
; restore previous status
lda prev_status
sta status
; disable the clock if the previous was not RECEIVE_KEYS
cmp #ps2kb::STATUS::RECEIVE_KEYS
beq @rts
_DisableClock
@rts:
rts
.endproc .endproc
.rodata
;; Can be used by other programs
FMT_CMD_FAIL: .asciiz "PS/2 Cmd fail: %x-%x > %x%x%x "