1
0
mirror of https://github.com/hsoft/collapseos.git synced 2024-11-30 19:58:05 +11:00

avra: add BEGIN, .. AGAIN,

This commit is contained in:
Virgil Dupras 2020-05-19 07:39:34 -04:00
parent 7b7e60ed4a
commit 8ca85abfbd
2 changed files with 75 additions and 10 deletions

View File

@ -8,4 +8,6 @@
SWAP @ 2 * ORG @ + PC 1- H@ ( opw addr tgt hbkp ) SWAP @ 2 * ORG @ + PC 1- H@ ( opw addr tgt hbkp )
ROT HERE ! ( opw tgt hbkp ) SWAP ROT EXECUTE H@ ! ( hbkp ) ROT HERE ! ( opw tgt hbkp ) SWAP ROT EXECUTE H@ ! ( hbkp )
HERE ! ; HERE ! ;
: BEGIN, PC ;
: AGAIN, ( op ) SWAP 1- SWAP EXECUTE A,, ;

View File

@ -201,16 +201,16 @@ DDRB DATA SBI,
L3 FLBL, ( RCALL checkBoundsZ ) L3 FLBL, ( RCALL checkBoundsZ )
16 8 LDI, 16 8 LDI,
L7 LBL! ( sendToPS2Loop ) BEGIN,
PORTB DATA CBI, PORTB DATA CBI,
20 7 SBRC, ( if leftmost bit isn't cleared, set DATA high ) 20 7 SBRC, ( if leftmost bit isn't cleared, set DATA high )
PORTB DATA SBI, PORTB DATA SBI,
( toggle CP ) ( toggle CP )
PORTB CP CBI, PORTB CP CBI,
20 LSL, 20 LSL,
PORTB CP SBI, PORTB CP SBI,
16 DEC, 16 DEC,
L7 ' BRNE LBL, ( sendToPS2Loop, not zero yet? loop ) ' BRNE AGAIN, ( not zero yet? loop )
( release PS/2 ) ( release PS/2 )
DDRB DATA CBI, DDRB DATA CBI,
SEI, SEI,
@ -234,3 +234,66 @@ CLI,
PORTB CLK CBI, PORTB CLK CBI,
DDRB CLK SBI, DDRB CLK SBI,
L2 ' RCALL LBL, ( resetTimer ) L2 ' RCALL LBL, ( resetTimer )
( Wait until the timer overflows )
BEGIN,
16 TIFR IN,
16 1 ( TOV0 ) SBRS,
' RJMP AGAIN,
( Good, 100us passed. )
( Pull Data low, that's our start bit. )
PORTB DATA CBI,
DDRB DATA SBI,
( Now, let's release the clock. At the next raising edge, we'll
be expected to have set up our first bit (LSB). We set up
when CLK is low. )
DDRB CLK CBI, ( Should be starting high now. )
( We will do the next loop 8 times )
16 8 LDI,
( Let's remember initial r19 for parity )
1 19 MOV,
BEGIN,
( Wait for CLK to go low )
BEGIN, PINB CLK SBIC, ' RJMP AGAIN,
( set up DATA )
PORTB DATA CBI,
19 0 SBRC, ( skip if LSB is clear )
PORTB DATA SBI,
19 LSR,
( Wait for CLK to go high )
BEGIN, PINB CLK SBIS, ' RJMP AGAIN,
16 DEC,
' BRNE AGAIN, ( not zero? loop )
( Data was sent, CLK is high. Let's send parity )
19 1 MOV, ( recall saved value )
L6 FLBL, ( RCALL checkParity )
( Wait for CLK to go low )
BEGIN, PINB CLK SBIC, ' RJMP AGAIN,
( set parity bit )
PORTB DATA CBI,
16 0 SBRC, ( parity bit in r16 )
PORTB DATA SBI,
( Wait for CLK to go high )
BEGIN, PINB CLK SBIS, ' RJMP AGAIN,
( Wait for CLK to go low )
BEGIN, PINB CLK SBIC, ' RJMP AGAIN,
( We can now release the DATA line )
DDRB DATA CBI,
( Wait for DATA to go low, that's our ACK )
BEGIN, PINB DATA SBIC, ' RJMP AGAIN,
( Wait for CLK to go low )
BEGIN, PINB CLK SBIC, ' RJMP AGAIN,
( We're finished! Enable INT0, reset timer, everything back to
normal! )
L2 ' RCALL LBL, ( resetTimer )
CLT, ( also, make sure T isn't mistakely set. )
SEI,
RET,
L8 ' RCALL FLBL! ( checkBoundsY )
( Check that Y is within bounds, reset to SRAM_START if not. )
28 ( YL ) TST,