|
|
@@ -1,9 +1,16 @@ |
|
|
|
CODE _sdcSel |
|
|
|
SDC_CSLOW OUTnA, |
|
|
|
CODE _sdcSel SDC_CSLOW OUTnA, ;CODE |
|
|
|
CODE _sdcDesel SDC_CSHIGH OUTnA, ;CODE |
|
|
|
( Computes n into crc c with polynomial 0x1021 ) |
|
|
|
CODE _crc16 ( c n -- c ) |
|
|
|
HL POPqq, ( n ) DE POPqq, ( c ) |
|
|
|
A L LDrr, D XORr, D A LDrr, |
|
|
|
B 8 LDrn, |
|
|
|
BEGIN, |
|
|
|
E SLAr, D RLr, |
|
|
|
IFC, ( msb is set, apply polynomial ) |
|
|
|
A D LDrr, 0x10 XORn, D A LDrr, |
|
|
|
A E LDrr, 0x21 XORn, E A LDrr, |
|
|
|
THEN, |
|
|
|
DJNZ, AGAIN, |
|
|
|
DE PUSHqq, |
|
|
|
;CODE |
|
|
|
|
|
|
|
CODE _sdcDesel |
|
|
|
SDC_CSHIGH OUTnA, |
|
|
|
;CODE |
|
|
|
|
|
|
|
|