avra: implement LD/ST

Still making great progress on sms/kbd/ps2ctl. Still matching ref
binary.

blk/660

@@ -1 +1 @@
-1 10 LOADR+
+1 11 LOADR+

blk/662

@@ -5,4 +5,3 @@
 : _r64c DUP 63 > IF _oor THEN ;
 : _r256c DUP 255 > IF _oor THEN ;
 : _Rdp ( op rd -- op', place Rd ) 4 LSHIFT OR ;
-

blk/667

@@ -10,4 +10,4 @@
 0b1111110000000000 OPRdb SBRC, 0b1111111000000000 OPRdb SBRS,
 
 ( special cases )
-: CLR, DUP EOR, ;  : TST, DUP AND, ;
+: CLR, DUP EOR, ;  : TST, DUP AND, ; : LSL, DUP ADD, ;

blk/670

@@ -1,11 +1,6 @@
-( L1 LBL! .. L1 ' RJMP LBL, )
-: LBL! ( l -- ) PC SWAP ! ;
-: LBL, ( l op -- ) SWAP @ 1- SWAP EXECUTE A,, ;
-( L1 FLBL, .. L1 ' RJMP FLBL! )
-: FLBL, ( l -- ) LBL! 0 A,, ;
-: FLBL! ( l opw -- )
-    ( warning: l is a PC offset, not a mem addr! )
-    SWAP @ 2 * ORG @ + PC 1- H@ ( opw addr tgt hbkp )
-    ROT HERE ! ( opw tgt hbkp ) SWAP ROT EXECUTE H@ ! ( hbkp )
-    HERE ! ;
-
+0b11100 CONSTANT X 0b01000 CONSTANT Y 0b00000 CONSTANT Z
+0b11101 CONSTANT X+ 0b11001 CONSTANT Y+ 0b10001 CONSTANT Z+
+0b11110 CONSTANT -X 0b11010 CONSTANT -Y 0b10010 CONSTANT -Z
+: _ldst ( Rd XYZ op ) SWAP DUP 0x10 AND 8 LSHIFT SWAP 0xf AND
+    OR OR ( Rd op' ) SWAP _Rdp A,, ;
+: LD, 0x8000 _ldst ; : ST, SWAP 0x8200 _ldst ;

blk/671

@@ -0,0 +1,11 @@
+( L1 LBL! .. L1 ' RJMP LBL, )
+: LBL! ( l -- ) PC SWAP ! ;
+: LBL, ( l op -- ) SWAP @ 1- SWAP EXECUTE A,, ;
+( L1 FLBL, .. L1 ' RJMP FLBL! )
+: FLBL, ( l -- ) LBL! 0 A,, ;
+: FLBL! ( l opw -- )
+    ( warning: l is a PC offset, not a mem addr! )
+    SWAP @ 2 * ORG @ + PC 1- H@ ( opw addr tgt hbkp )
+    ROT HERE ! ( opw tgt hbkp ) SWAP ROT EXECUTE H@ ! ( hbkp )
+    HERE ! ;
+

recipes/sms/kbd/ps2ctl.fs

@@ -41,6 +41,7 @@ Z: pointer to the next scan code to push to the 595 )
 0x33 CONSTANT TCCR0B
 0x3b CONSTANT GIMSK
 0x38 CONSTANT TIFR
+0x32 CONSTANT TCNT0
 0x16 CONSTANT PINB
 0x17 CONSTANT DDRB
 0x18 CONSTANT PORTB
@@ -49,7 +50,7 @@ Z: pointer to the next scan code to push to the 595 )
 3 CONSTANT CP
 0 CONSTANT LQ
 4 CONSTANT LR
-0x100-100 CONSTANT TIMER_INITVAL
+0x100 100 - CONSTANT TIMER_INITVAL
 ( We need a lot of labels in this program... )
 VARIABLE L5 VARIABLE L6 VARIABLE L7 VARIABLE L8
 
@@ -131,5 +132,105 @@ L7 FLBL, ( BREQ processbits2 )
 18 CLR, ( happens in all cases )
 ( DATA has to be set )
 19 TST, ( was DATA set? )
-L1 ' BREQ FLBL! ( loop, not set? error, don't push to buf )
+L1 ' BREQ LBL, ( loop, not set? error, don't push to buf )
 ( push r17 to the buffer )
+Y+ 17 ST,
+L8 FLBL, ( RCALL checkBoundsY )
+L1 ' RJMP LBL,
+
+L5 ' BREQ FLBL! ( processbits0 )
+( step 0 - start bit )
+( DATA has to be cleared )
+19 TST, ( was DATA set? )
+L1 ' BRNE LBL, ( loop. set? error. no need to do anything. keep
+                 r18 as-is. )
+( DATA is cleared. prepare r17 and r18 for step 1 )
+18 INC,
+17 0x80 LDI,
+L1 ' RJMP LBL, ( loop )
+
+L6 ' BREQ FLBL! ( processbits1 )
+( step 1 - receive bit
+  We're about to rotate the carry flag into r17. Let's set it
+  first depending on whether DATA is set. )
+CLC,
+19 0 SBRC, ( skip if DATA is cleared )
+SEC,
+( Carry flag is set )
+17 ROR,
+( Good. now, are we finished rotating? If carry flag is set,
+  it means that we've rotated in 8 bits. )
+L1 ' BRCC LBL, ( loop )
+( We're finished, go to step 2 )
+18 INC,
+L1 ' RJMP LBL, ( loop )
+
+L7 ' BREQ FLBL! ( processbits2 )
+( step 2 - parity bit )
+1 19 MOV,
+19 17 MOV,
+L5 FLBL, ( RCALL checkParity )
+1 16 CP,
+L6 FLBL, ( BRNE processBitError, r1 != r16? wrong parity )
+18 INC,
+L1 ' RJMP LBL, ( loop )
+
+L6 ' BRNE FLBL! ( processBitError )
+18 CLR,
+19 0xfe LDI,
+L6 FLBL, ( RCALL sendToPS2 )
+L1 ' RJMP LBL, ( loop )
+
+L4 ' RJMP FLBL! ( processbitReset )
+18 CLR,
+L4 FLBL, ( RCALL resetTimer )
+L1 ' RJMP LBL, ( loop )
+
+L3 ' BRNE FLBL! ( sendTo164 )
+( Send the value of r20 to the '164 )
+PINB LQ SBIS, ( LQ is set? we can send the next byte )
+L1 ' RJMP LBL, ( loop, even if we have something in the
+                 buffer, we can't: the SMS hasn't read our
+                 previous buffer yet. )
+( We disable any interrupt handling during this routine.
+  Whatever it is, it has no meaning to us at this point in time
+  and processing it might mess things up. )
+CLI,
+DDRB DATA SBI,
+20 Z+ LD,
+L3 FLBL, ( RCALL checkBoundsZ )
+16 8 LDI,
+
+L7 LBL! ( sendToPS2Loop )
+PORTB DATA CBI,
+20 7 SBRC, ( if leftmost bit isn't cleared, set DATA high )
+PORTB DATA SBI,
+( toggle CP )
+PORTB CP CBI,
+20 LSL,
+PORTB CP SBI,
+16 DEC,
+L7 ' BRNE LBL, ( sendToPS2Loop, not zero yet? loop )
+( release PS/2 )
+DDRB DATA CBI,
+SEI,
+( Reset the latch to indicate that the next number is ready )
+PORTB LR SBI,
+PORTB LR CBI,
+L1 ' RJMP LBL, ( loop )
+
+L2 ' RCALL FLBL! L4 ' RCALL FLBL! L2 LBL! ( resetTimer )
+16 TIMER_INITVAL LDI,
+TCNT0 16 OUT,
+16 0x02 ( TOV0 ) LDI,
+TIFR 16 OUT,
+RET,
+
+L6 ' RCALL FLBL! ( sendToPS2 )
+( Send the value of r19 to the PS/2 keyboard )
+CLI,
+( First, indicate our request to send by holding both Clock low
+  for 100us, then pull Data low lines low for 100us. )
+PORTB CLK CBI,
+DDRB CLK SBI,
+L2 ' RCALL LBL, ( resetTimer )