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:
parent
7b7e60ed4a
commit
8ca85abfbd
2
blk/671
2
blk/671
@ -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,, ;
|
||||||
|
|
||||||
|
@ -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,
|
||||||
|
Loading…
Reference in New Issue
Block a user