radix dec global__variables__bank0 equ 32 global__variables__bank1 equ 160 global__variables__bank2 equ 288 global__variables__bank3 equ 496 global__bit__variables__bank0 equ 92 global__bit__variables__bank1 equ 160 global__bit__variables__bank2 equ 288 global__bit__variables__bank3 equ 496 indf___register equ 0 pcl___register equ 2 c___byte equ 3 c___bit equ 0 z___byte equ 3 z___bit equ 2 rp0___byte equ 3 rp0___bit equ 5 rp1___byte equ 3 rp1___bit equ 6 irp___byte equ 3 irp___bit equ 7 trisa___register equ 0x85 trisb___register equ 0x86 fsr___register equ 4 pclath___register equ 10 org 0 start: nop nop nop goto skip___interrupt interrupt___vector: retfie skip___interrupt: ; Initialize A/D system to allow digital I/O movlw 7 movwf 31 ; Switch from register bank 0 to register bank 1 (which contains 159) bsf rp0___byte,rp0___bit ; Register bank is now 1 clrf 159 ; Initialize TRIS registers movlw 235 movwf trisb___register clrf pclath___register ; Switch from register bank 1 to register bank 0 bcf rp0___byte,rp0___bit ; Register bank is now 0 goto main ; comment ############################################################################# ; comment {} ; comment {Copyright < c > 1999 - 2001 by Wayne C . Gramlich .} ; comment {All rights reserved .} ; comment {} ; comment {Permission to use , copy , modify , distribute , and sell this software} ; comment {for any purpose is hereby granted without fee provided that the above} ; comment {copyright notice and this permission are retained . The author makes} ; comment {no representations about the suitability of this software for any purpose .} ; comment {It is provided { as is } without express or implied warranty .} ; comment {} ; comment {This is a test harness for testing the LED10 RoboBrick . See :} ; comment {} ; comment {http : / / web . gramlich . net / projects / robobricks / led10 / index . html} ; comment {} ; comment {for more details .} ; comment {} ; comment ############################################################################# ; processor pic16f628 cp = off cpd = off lvp = off bowden = off mclre = on pwrte = off wdte = off fosc = xt ; 16169=0x3f29 8199=0x2007 __config 16169 configuration___address equ 8199 ; comment {processor pic16f84 cp = off dp = off pwrte = disabled wdte = disabled fosc = xt} ; constant clock_rate 10000000 clock_rate equ 10000000 ; constant clock_ticks_per_instruction 4 clock_ticks_per_instruction equ 4 ; constant instructions_per_second clock_rate / clock_ticks_per_instruction instructions_per_second equ 2500000 ; constant baud_rate 2400 baud_rate equ 2400 ; constant instructions_per_bit clock_rate / {{ clock_ticks_per_instruction * baud_rate }} instructions_per_bit equ 1041 ; constant delays_per_bit 3 delays_per_bit equ 3 ; constant instructions_per_delay instructions_per_bit / delays_per_bit instructions_per_delay equ 347 ; constant extra_instructions_per_bit 12 extra_instructions_per_bit equ 12 ; comment {constant extra_instructions_per_bit 0} ; constant extra_instructions_per_delay extra_instructions_per_bit / delays_per_bit extra_instructions_per_delay equ 4 ; constant delay_instructions instructions_per_delay - extra_instructions_per_delay delay_instructions equ 343 ; comment {The null pulse that comes back from a clock pulse command is supposed to be} ; comment {exactly 9 bits long . 9 bits at 2400 baud is 9 / 2400 = 3 . 75 mS . The number} ; comment {iterations through the loop is 3 . 75 mS / < number of instructions per iteration . >} ; constant nine_bits_instructions {{ clock_rate * 9 }} / {{ clock_ticks_per_instruction * baud_rate }} nine_bits_instructions equ 9375 ; constant instructions_per_iteration 7 instructions_per_iteration equ 7 ; constant iterations_for_nine_bits nine_bits_instructions / instructions_per_iteration iterations_for_nine_bits equ 1339 ; constant iterations_high iterations_for_nine_bits / 256 iterations_high equ 5 ; constant iterations_low iterations_for_nine_bits - {{ iterations_high * 256 }} iterations_low equ 59 ; constant sp 32 sp equ 32 ; constant cr 13 cr equ 13 ; constant lf 10 lf equ 10 ; comment {Some bit definitions :} ; constant rx_slave_bit 5 rx_slave_bit equ 5 ; constant tx_slave_bit 4 tx_slave_bit equ 4 ; constant rx_master_bit 1 rx_master_bit equ 1 ; constant tx_master_bit 2 tx_master_bit equ 2 ; constant rx_slave_mask 1 << rx_slave_bit rx_slave_mask equ 32 ; constant tx_slave_mask 1 << tx_slave_bit tx_slave_mask equ 16 ; constant rx_master_mask 1 << rx_master_bit rx_master_mask equ 2 ; constant tx_master_mask 1 << tx_master_bit tx_master_mask equ 4 status equ 3 ; bind c status @ 0 c equ status+0 c__byte equ status+0 c__bit equ 0 ; bind z status @ 2 z equ status+0 z__byte equ status+0 z__bit equ 2 ; comment {Some port and pin definitions :} ; comment {port porta a unused none} portb equ 6 tx_master_pin__byte equ 6 tx_master_pin__bit equ 2 rx_master_pin__byte equ 6 rx_master_pin__bit equ 1 tx_slave_pin__byte equ 6 tx_slave_pin__bit equ 4 rx_slave_pin__byte equ 6 rx_slave_pin__bit equ 5 ; constant space 0xff space equ 255 ; constant buffer_size 5 buffer_size equ 5 ; string_constants Start string___fetch: movwf pcl___register ; bit_string = 0s'Bit' bit_string___string equ 0 bit_string: addwf pcl___register,f ; Length = 3 retlw 3 ; `Bit' retlw 66 retlw 105 retlw 116 ; blink_string = 0s'Blink' blink_string___string equ 5 blink_string: addwf pcl___register,f ; Length = 5 retlw 5 ; `Blink' retlw 66 retlw 108 retlw 105 retlw 110 retlw 107 ; clock_string = 0s'Clk' clock_string___string equ 12 clock_string: addwf pcl___register,f ; Length = 3 retlw 3 ; `Clk' retlw 67 retlw 108 retlw 107 ; common_string = 0s'Common' common_string___string equ 17 common_string: addwf pcl___register,f ; Length = 6 retlw 6 ; `Common' retlw 67 retlw 111 retlw 109 retlw 109 retlw 111 retlw 110 ; done_string = 0s'Done' done_string___string equ 25 done_string: addwf pcl___register,f ; Length = 4 retlw 4 ; `Done' retlw 68 retlw 111 retlw 110 retlw 101 ; fail_string = 0s'Fail' fail_string___string equ 31 fail_string: addwf pcl___register,f ; Length = 4 retlw 4 ; `Fail' retlw 70 retlw 97 retlw 105 retlw 108 ; hello_string = 0s'LED10_Test' hello_string___string equ 37 hello_string: addwf pcl___register,f ; Length = 10 retlw 10 ; `LED10_Test' retlw 76 retlw 69 retlw 68 retlw 49 retlw 48 retlw 95 retlw 84 retlw 101 retlw 115 retlw 116 ; patterns = 0 , 1 , 2 , 4 , 8 , 0x10 , 0x20 , 0x40 , 0x80 , 0xff , 0 patterns___string equ 49 patterns: addwf pcl___register,f ; Length = 11 retlw 11 ; 0 retlw 0 ; 1 retlw 1 ; 2 retlw 2 ; 4 retlw 4 ; 8 retlw 8 ; 0x10 retlw 16 ; 0x20 retlw 32 ; 0x40 retlw 64 ; 0x80 retlw 128 ; 0xff retlw 255 ; 0 retlw 0 ; ramps = 0 , 1 , 0x10 , 0x80 , 0xff ramps___string equ 62 ramps: addwf pcl___register,f ; Length = 5 retlw 5 ; 0 retlw 0 ; 1 retlw 1 ; 0x10 retlw 16 ; 0x80 retlw 128 ; 0xff retlw 255 ; read_string = 0s'Read' read_string___string equ 69 read_string: addwf pcl___register,f ; Length = 4 retlw 4 ; `Read' retlw 82 retlw 101 retlw 97 retlw 100 ; register_string = 0s'Reg' register_string___string equ 75 register_string: addwf pcl___register,f ; Length = 3 retlw 3 ; `Reg' retlw 82 retlw 101 retlw 103 ; string__constants End ; procedure main start main: main__variables__base equ global__variables__bank0+0 main__bytes__base equ main__variables__base+0 main__bits__base equ main__variables__base+10 main__total__bytes equ 10 main__117byte0 equ main__bytes__base+9 main__145byte0 equ main__bytes__base+9 ; arguments_none ; Read a byte . main__buffer equ main__bytes__base+0 main__char equ main__bytes__base+5 main__count equ main__bytes__base+6 main__index equ main__bytes__base+7 main__number equ main__bytes__base+8 ; Print out a welcome message : ; call master_crlf {{ }} call master_crlf ; call master_string {{ hello_string }} movlw LOW hello_string+1 movwf master_string__message call master_string ; call master_crlf {{ }} call master_crlf ; Main loop ; number := 0 clrf main__number ; loop_forever ... start main__106loop__forever: ; Get a character : ; tx_slave_pin := 1 bsf tx_slave_pin__byte,tx_slave_pin__bit ; char := master_get {{ }} call master_get movf master_get__0return__byte,w movwf main__char ; Delay 1 / 3 ' s of bit make sure that get_byte is done . ; call delay {{ }} call delay ; if { 0c'0' <= char && char < {{ 0c'9' + 1 }} } start movlw 48 subwf main__char,w ; expression=`0c'0' <= char' exp_delay=2 true_delay=-1 false_delay=1 true_size=132 false_size=1 btfss c___byte,c___bit goto and114__0false movlw 58 subwf main__char,w ; expression=`char < {{ 0c'9' + 1 }}' exp_delay=2 true_delay=9 false_delay=-1 true_size=11 false_size=116 btfsc c___byte,c___bit goto label114__1false label114__1true: and114__0true: ; if { 0c'0' <= char && char < {{ 0c'9' + 1 }} } body start ; Do a multiply by 8 then add in digit : ; call master_send {{ char }} movf main__char,w movwf master_send__character call master_send ; number := {{ number << 3 }} + char - 0c'0' rlf main__number,w movwf main__117byte0 rlf main__117byte0,f rlf main__117byte0,w andlw 248 addwf main__char,w addlw 208 movwf main__number ; if { 0c'0' <= char && char < {{ 0c'9' + 1 }} } body end goto label114__1end label114__1false: and114__0false: movlw 115 subwf main__char,w ; expression=`{ char = 0c's' }' exp_delay=2 true_delay=-1 false_delay=-1 true_size=8 false_size=103 btfss z___byte,z___bit goto label118__0false label118__0true: ; else_if { char = 0c's' } body start ; Send byte to brick , no wait : ; Echo command and send CRLF : ; call master_send {{ char }} movf main__char,w movwf master_send__character call master_send ; call master_crlf {{ }} call master_crlf ; Ship the byte down to the brick : ; call slave_send {{ number }} movf main__number,w movwf slave_send__data call slave_send ; number := 0 clrf main__number ; else_if { char = 0c's' } body end goto label118__0end label118__0false: movlw 119 subwf main__char,w ; expression=`{ char = 0c'w' }' exp_delay=2 true_delay=-1 false_delay=-1 true_size=39 false_size=59 btfss z___byte,z___bit goto label129__0false label129__0true: ; else_if { char = 0c'w' } body start ; Send byte to brick , wait for results : ; Echo command and send CRLF : ; call master_send {{ char }} movf main__char,w movwf master_send__character call master_send ; call master_crlf {{ }} call master_crlf ; Ship the byte down to the brick ... ; call slave_send {{ number }} movf main__number,w movwf slave_send__data call slave_send ; number := 0 clrf main__number ; call delay < > ; ... and wait for a response : ; index := 0 clrf main__index ; `while index < buffer_size ...' start main__144while__continue: movlw 5 subwf main__index,w ; expression=` index < buffer_size ' exp_delay=2 true_delay=10 false_delay=2 true_size=11 false_size=1 btfsc c___byte,c___bit goto main__144while__break ; buffer ~~ {{ index }} := slave_get {{ }} call slave_get movf slave_get__0return__byte,w movwf main__145byte0 movlw LOW main__buffer addwf main__index,w movwf fsr___register movf main__145byte0,w bcf irp___register,irp___bit movwf indf___register ; index := index + 1 incf main__index,f goto main__144while__continue ; if exp=` index < buffer_size ' false goto ; Other expression=` index < buffer_size ' delay=-1 main__144while__break: ; `while index < buffer_size ...' end ; index := 0 clrf main__index ; `while index < buffer_size ...' start main__150while__continue: movlw 5 subwf main__index,w ; expression=` index < buffer_size ' exp_delay=2 true_delay=8 false_delay=2 true_size=9 false_size=1 btfsc c___byte,c___bit goto main__150while__break ; call master_octal {{ buffer ~~ {{ index }} }} movlw LOW main__buffer addwf main__index,w movwf fsr___register bcf irp___register,irp___bit movf indf___register,w movwf master_octal__number call master_octal ; index := index + 1 incf main__index,f goto main__150while__continue ; if exp=` index < buffer_size ' false goto ; Other expression=` index < buffer_size ' delay=-1 main__150while__break: ; `while index < buffer_size ...' end ; Terminate the output list ; call master_crlf {{ }} call master_crlf ; else_if { char = 0c'w' } body end goto label129__0end label129__0false: movlw 105 subwf main__char,w ; expression=`{ char = 0c'i' }' exp_delay=2 true_delay=-1 false_delay=-1 true_size=12 false_size=42 btfss z___byte,z___bit goto label157__0false label157__0true: ; else_if { char = 0c'i' } body start ; Interrogate the slave RoboBrick : ; call master_send {{ char }} movf main__char,w movwf master_send__character call master_send ; call master_crlf {{ }} call master_crlf ; Initialize the id index : ; call slave_send {{ 0xfd }} movlw 253 movwf slave_send__data call slave_send ; Get the first 8 bytes : ; call common_test_id_bytes8 {{ }} call common_test_id_bytes8 ; Get the next 8 bytes of random numbers : ; call common_test_id_bytes8 {{ }} call common_test_id_bytes8 ; Get the next 8 bytes of random numbers : ; call common_test_id_bytes8 {{ }} call common_test_id_bytes8 ; Get the slave brick name : ; call common_test_id_string {{ }} call common_test_id_string ; Get the vendor name : ; call common_test_id_string {{ }} call common_test_id_string ; else_if { char = 0c'i' } body end goto label157__0end label157__0false: movlw 116 subwf main__char,w ; expression=`{ char = 0c't' }' exp_delay=2 true_delay=-1 false_delay=-1 true_size=5 false_size=32 btfss z___byte,z___bit goto label180__0false label180__0true: ; else_if { char = 0c't' } body start ; Do testing : ; call master_send {{ char }} movf main__char,w movwf master_send__character call master_send ; call master_crlf {{ }} call master_crlf ; call test {{ }} call test ; else_if { char = 0c't' } body end goto label180__0end label180__0false: movlw 99 subwf main__char,w ; expression=`{ char = 0c'c' }' exp_delay=2 true_delay=-1 false_delay=-1 true_size=8 false_size=19 btfss z___byte,z___bit goto label185__0false label185__0true: ; else_if { char = 0c'c' } body start ; Clock adjust : ; call master_send {{ char }} movf main__char,w movwf master_send__character call master_send ; call master_crlf {{ }} call master_crlf ; call clock_adjust {{ number }} movf main__number,w movwf clock_adjust__adjust call clock_adjust ; number := 0 clrf main__number ; else_if { char = 0c'c' } body end goto label185__0end label185__0false: movlw 252 subwf main__char,w ; expression=`{ char != 0xfc }' exp_delay=2 true_delay=-1 false_delay=0 true_size=15 false_size=0 btfsc z___byte,z___bit goto label191__0end ; else_if { char != 0xfc } body start ; Just echo back the current number : ; call master_send {{ 0c'<' }} movlw 60 movwf master_send__character call master_send ; call master_octal {{ char }} movf main__char,w movwf master_octal__number call master_octal ; call master_send {{ 0c'>' }} movlw 62 movwf master_send__character call master_send ; Send a carriage - return line - feed : ; call master_crlf {{ }} call master_crlf ; Output the character in octal : ; call master_octal {{ number }} movf main__number,w movwf master_octal__number call master_octal ; Send a carriage - return line - feed : ; call master_crlf {{ }} call master_crlf ; Reset number ; number := 0 clrf main__number ; else_if { char != 0xfc } body end label191__0end: ; if exp=` char != 0xfc ' empty false ; Other expression=`{ char != 0xfc }' delay=-1 ; if exp=` char = 0c'c' ' generic label185__0end: ; Other expression=`{ char = 0c'c' }' delay=-1 ; if exp=` char = 0c't' ' generic label180__0end: ; Other expression=`{ char = 0c't' }' delay=-1 ; if exp=` char = 0c'i' ' generic label157__0end: ; Other expression=`{ char = 0c'i' }' delay=-1 ; if exp=` char = 0c'w' ' generic label129__0end: ; Other expression=`{ char = 0c'w' }' delay=-1 ; if exp=` char = 0c's' ' generic label118__0end: ; Other expression=`{ char = 0c's' }' delay=-1 ; if exp=`char < {{ 0c'9' + 1 }}' generic label114__1end: ; Other expression=`char < {{ 0c'9' + 1 }}' delay=-1 ; if exp=`0c'0' <= char' false goto ; Other expression=`0c'0' <= char' delay=-1 and114__0end: ; if { 0c'0' <= char && char < {{ 0c'9' + 1 }} } end goto main__106loop__forever ; loop_forever ... end ; procedure main end ; procedure clock_adjust start clock_adjust: clock_adjust__variables__base equ global__variables__bank0+10 clock_adjust__bytes__base equ clock_adjust__variables__base+0 clock_adjust__bits__base equ clock_adjust__variables__base+9 clock_adjust__total__bytes equ 9 clock_adjust__269byte0 equ clock_adjust__bytes__base+8 clock_adjust__283byte0 equ clock_adjust__bytes__base+8 clock_adjust__279byte0 equ clock_adjust__bytes__base+8 clock_adjust__227byte0 equ clock_adjust__bytes__base+8 clock_adjust__adjust equ clock_adjust__bytes__base+0 ; This procedure will adjust the clock to the slave . clock_adjust__command equ clock_adjust__bytes__base+1 clock_adjust__count equ clock_adjust__bytes__base+2 clock_adjust__error equ clock_adjust__bytes__base+3 clock_adjust__error_minimum equ clock_adjust__bytes__base+4 clock_adjust__high equ clock_adjust__bytes__base+5 clock_adjust__low equ clock_adjust__bytes__base+6 clock_adjust__target equ clock_adjust__bytes__base+7 ; target := iterations_low - adjust movlw 59 movwf clock_adjust__227byte0 movf clock_adjust__adjust,w subwf clock_adjust__227byte0,w movwf clock_adjust__target ; count := 2 movlw 2 movwf clock_adjust__count ; error := 0xff movlw 255 movwf clock_adjust__error ; error_minimum := 0xf0 movlw 240 movwf clock_adjust__error_minimum ; Print out the target : ; call master_send {{ 0c'T' }} movlw 84 movwf master_send__character call master_send ; call master_octal {{ iterations_high }} movlw 5 movwf master_octal__number call master_octal ; call master_octal {{ target }} movf clock_adjust__target,w movwf master_octal__number call master_octal ; call master_crlf {{ }} call master_crlf ; loop_forever ... start clock_adjust__238loop__forever: ; Print out the clock value : ; call master_send {{ 0c'C' }} movlw 67 movwf master_send__character call master_send ; call slave_send {{ 0xfa }} movlw 250 movwf slave_send__data call slave_send ; call master_octal {{ slave_get {{ }} }} call slave_get movf slave_get__0return__byte,w movwf master_octal__number call master_octal ; Ask for a timing byte : ; call slave_send {{ 0xfb }} movlw 251 movwf slave_send__data call slave_send ; low := 0 clrf clock_adjust__low ; high := 0 clrf clock_adjust__high ; `while rx_slave_pin ...' start clock_adjust__249while__continue: ; expression=`rx_slave_pin' exp_delay=0 true_delay=2 false_delay=2 true_size=1 false_size=1 btfsc rx_slave_pin__byte,rx_slave_pin__bit ; Do nothing : goto clock_adjust__249while__continue goto clock_adjust__249while__break ; if exp=`rx_slave_pin' true goto small true clock_adjust__249while__break: ; `while rx_slave_pin ...' end ; `while ! rx_slave_pin ...' start clock_adjust__252while__continue: ; expression=`rx_slave_pin' exp_delay=0 true_delay=2 false_delay=5 true_size=1 false_size=4 btfsc rx_slave_pin__byte,rx_slave_pin__bit goto clock_adjust__252while__break ; low := low + 1 incf clock_adjust__low,f ; if { z } start ; expression=`{ z }' exp_delay=0 true_delay=1 false_delay=0 true_size=1 false_size=0 btfsc z__byte,z__bit ; if { z } body start ; high := high + 1 incf clock_adjust__high,f ; if { z } body end ; if exp=`z' false skip delay=2 ; Other expression=`{ z }' delay=2 ; if { z } end goto clock_adjust__252while__continue ; if exp=`rx_slave_pin' true goto ; Other expression=`rx_slave_pin' delay=-1 clock_adjust__252while__break: ; `while ! rx_slave_pin ...' end ; Print out high and low : ; call master_send {{ 0c'H' }} movlw 72 movwf master_send__character call master_send ; call master_octal {{ high }} movf clock_adjust__high,w movwf master_octal__number call master_octal ; call master_send {{ 0c'L' }} movlw 76 movwf master_send__character call master_send ; call master_octal {{ low }} movf clock_adjust__low,w movwf master_octal__number call master_octal ; Now think about adjusting clock . ; if { high > iterations_high } start movlw 6 subwf clock_adjust__high,w ; expression=`{ high > iterations_high }' exp_delay=2 true_delay=7 false_delay=-1 true_size=7 false_size=36 btfsc c___byte,c___bit goto label266__0true label266__0false: movlw 5 subwf clock_adjust__high,w ; expression=`{ high < iterations_high }' exp_delay=2 true_delay=4 false_delay=-1 true_size=4 false_size=27 btfss c___byte,c___bit goto label270__0true label270__0false: ; else body start ; The high 8 - bits are equal : ; if { low > target } start movf clock_adjust__low,w subwf clock_adjust__target,w ; expression=`{ low > target }' exp_delay=2 true_delay=7 false_delay=-1 true_size=7 false_size=15 btfss c___byte,c___bit goto label276__0true label276__0false: movf clock_adjust__target,w subwf clock_adjust__low,w ; expression=`{ low < target }' exp_delay=2 true_delay=7 false_delay=3 true_size=7 false_size=3 btfss c___byte,c___bit goto label280__0true label280__0false: ; else body start ; Exact match ; we are done : ; command := 0 clrf clock_adjust__command ; error := 0 clrf clock_adjust__error ; error_minimum := 0 clrf clock_adjust__error_minimum ; else body end goto label280__0end label280__0true: ; else_if { low < target } body start ; Clock pulse is too short ; slave clock is too fast : ; command := 0xf8 movlw 248 movwf clock_adjust__command ; error := target - low movf clock_adjust__target,w movwf clock_adjust__283byte0 movf clock_adjust__low,w subwf clock_adjust__283byte0,w movwf clock_adjust__error ; else_if { low < target } body end ; if exp=` low < target ' generic label280__0end: ; Other expression=`{ low < target }' delay=-1 goto label276__0end label276__0true: ; if { low > target } body start ; Clock pulse is too long ; slave clock is too slow : ; command := 0xf9 movlw 249 movwf clock_adjust__command ; error := low - target movf clock_adjust__low,w movwf clock_adjust__279byte0 movf clock_adjust__target,w subwf clock_adjust__279byte0,w movwf clock_adjust__error ; if { low > target } body end ; if exp=` low > target ' generic label276__0end: ; Other expression=`{ low > target }' delay=-1 ; if { low > target } end ; else body end goto label270__0end label270__0true: ; else_if { high < iterations_high } body start ; Clock pulse is too short ; slave clock is too fast : ; command := 0xf8 movlw 248 movwf clock_adjust__command ; error := target movf clock_adjust__target,w movwf clock_adjust__error ; else_if { high < iterations_high } body end ; if exp=` high < iterations_high ' generic label270__0end: ; Other expression=`{ high < iterations_high }' delay=-1 goto label266__0end label266__0true: ; if { high > iterations_high } body start ; Clock pulse is too long ; slave clock is too slow : ; command := 0xf9 movlw 249 movwf clock_adjust__command ; error := 0xff - target movlw 255 movwf clock_adjust__269byte0 movf clock_adjust__target,w subwf clock_adjust__269byte0,w movwf clock_adjust__error ; if { high > iterations_high } body end ; if exp=` high > iterations_high ' generic label266__0end: ; Other expression=`{ high > iterations_high }' delay=-1 ; if { high > iterations_high } end ; Print out the error and error minimum : ; call master_send {{ 0c'E' }} movlw 69 movwf master_send__character call master_send ; call master_octal {{ error }} movf clock_adjust__error,w movwf master_octal__number call master_octal ; call master_send {{ 0c'M' }} movlw 77 movwf master_send__character call master_send ; call master_octal {{ error_minimum }} movf clock_adjust__error_minimum,w movwf master_octal__number call master_octal ; if { error = error_minimum } start movf clock_adjust__error,w subwf clock_adjust__error_minimum,w ; expression=`{ error = error_minimum }' exp_delay=2 true_delay=-1 false_delay=-1 true_size=2 false_size=14 btfss z___byte,z___bit goto label298__0false label298__0true: ; if { error = error_minimum } body start ; call master_crlf {{ }} call master_crlf ; return retlw 0 ; if { error = error_minimum } body end goto label298__0end label298__0false: movf clock_adjust__error_minimum,w subwf clock_adjust__error,w ; expression=`{ error < error_minimum }' exp_delay=2 true_delay=3 false_delay=-1 true_size=3 false_size=6 btfss c___byte,c___bit goto label301__0true label301__0false: ; else body start ; count := count - 1 decf clock_adjust__count,f ; if { z } start ; expression=`{ z }' exp_delay=0 true_delay=3 false_delay=0 true_size=3 false_size=0 btfss z__byte,z__bit goto label306__0end ; if { z } body start ; error_minimum := error_minimum + 1 incf clock_adjust__error_minimum,f ; count := 2 movlw 2 movwf clock_adjust__count ; if { z } body end label306__0end: ; if exp=`z' empty false ; Other expression=`{ z }' delay=-1 ; if { z } end ; else body end goto label301__0end label301__0true: ; else_if { error < error_minimum } body start ; error_minimum := error movf clock_adjust__error,w movwf clock_adjust__error_minimum ; error := error + 1 incf clock_adjust__error,f ; else_if { error < error_minimum } body end ; if exp=` error < error_minimum ' generic label301__0end: ; Other expression=`{ error < error_minimum }' delay=-1 ; if exp=` error = error_minimum ' generic label298__0end: ; Other expression=`{ error = error_minimum }' delay=-1 ; if { error = error_minimum } end ; Now adjust the clock : ; call slave_send {{ command }} movf clock_adjust__command,w movwf slave_send__data call slave_send ; call master_crlf {{ }} call master_crlf goto clock_adjust__238loop__forever ; loop_forever ... end ; procedure clock_adjust end ; procedure test start test: test__variables__base equ global__variables__bank0+19 test__bytes__base equ test__variables__base+0 test__bits__base equ test__variables__base+6 test__total__bytes equ 6 test__421byte0 equ test__bytes__base+5 test__416byte0 equ test__bytes__base+5 ; arguments_none ; This procedure will test the LED10 RoboBrick : test__bit equ test__bytes__base+0 test__high equ test__bytes__base+1 test__level equ test__bytes__base+2 test__low equ test__bytes__base+3 test__temp equ test__bytes__base+4 ; Verify that the common commands are working : ; call common_test {{ }} call common_test ; Clear the LEDS : ; call slave_send {{ 0 }} clrf slave_send__data call slave_send ; call slave_send {{ 0x20 }} movlw 32 movwf slave_send__data call slave_send ; call test_prompt {{ 0 , 0 }} clrf test_prompt__high clrf test_prompt__low call test_prompt ; Let ' s do some simple testing first : ; high := 0 clrf test__high ; low := 1 movlw 1 movwf test__low ; `while ! {{ high @ 5 }} ...' start test__342while__continue: ; Alias variable for select high @ 5 test__high__342select0 equ test__high+0 test__high__342select0__byte equ test__high+0 test__high__342select0__bit equ 5 ; expression=`{{ high @ 5 }}' exp_delay=0 true_delay=2 false_delay=1 true_size=1 false_size=28 btfsc test__high__342select0__byte,test__high__342select0__bit goto test__342while__break ; Set the bits : ; call slave_send {{ low }} movf test__low,w movwf slave_send__data call slave_send ; call slave_send {{ 0x20 | high }} movlw 32 iorwf test__high,w movwf slave_send__data call slave_send ; call test_prompt {{ high , low }} movf test__high,w movwf test_prompt__high movf test__low,w movwf test_prompt__low call test_prompt ; call test_verify {{ high , low }} movf test__high,w movwf test_verify__high movf test__low,w movwf test_verify__low call test_verify ; Go to next level : ; if { low @ 4 } start ; Alias variable for select low @ 4 test__low__350select0 equ test__low+0 test__low__350select0__byte equ test__low+0 test__low__350select0__bit equ 4 ; expression=`{ low @ 4 }' exp_delay=0 true_delay=3 false_delay=4 true_size=3 false_size=4 btfss test__low__350select0__byte,test__low__350select0__bit goto label350__1false label350__1true: ; if { low @ 4 } body start ; high := 1 movlw 1 movwf test__high ; low := 0 clrf test__low ; if { low @ 4 } body end goto label350__1end label350__1false: ; else body start ; high := high << 1 bcf c___byte,c___bit rlf test__high,f ; low := low << 1 bcf c___byte,c___bit rlf test__low,f ; else body end ; if exp=` low @ 4 ' generic label350__1end: ; Other expression=`{ low @ 4 }' delay=-1 ; if { low @ 4 } end goto test__342while__continue ; if exp=` high @ 5 ' true goto ; Other expression=`{{ high @ 5 }}' delay=-1 test__342while__break: ; `while ! {{ high @ 5 }} ...' end ; Clear the high order bit : ; call slave_send {{ 0x20 }} movlw 32 movwf slave_send__data call slave_send ; Let ' s test out the bit twiddle commands : ; bit := 0 clrf test__bit ; high := 0 clrf test__high ; low := 1 movlw 1 movwf test__low ; `while bit < 10 ...' start test__365while__continue: movlw 10 subwf test__bit,w ; expression=` bit < 10 ' exp_delay=2 true_delay=1 false_delay=2 true_size=80 false_size=1 btfsc c___byte,c___bit goto test__365while__break ; Bit set : ; call slave_send {{ 0x50 | bit }} movlw 80 iorwf test__bit,w movwf slave_send__data call slave_send ; call test_verify {{ high , low }} movf test__high,w movwf test_verify__high movf test__low,w movwf test_verify__low call test_verify ; Read the bit : ; call slave_send {{ 0x70 | bit }} movlw 112 iorwf test__bit,w movwf slave_send__data call slave_send ; temp := slave_get {{ }} call slave_get movf slave_get__0return__byte,w movwf test__temp ; if { temp != 1 } start decf test__temp,w ; expression=`{ temp != 1 }' exp_delay=1 true_delay=4 false_delay=0 true_size=8 false_size=0 btfsc z___byte,z___bit goto label373__0end ; if { temp != 1 } body start ; call master_octal {{ temp }} movf test__temp,w movwf master_octal__number call master_octal ; call master_fail {{ bit_string , 0x30 }} movlw LOW bit_string+1 movwf master_fail__test_name movlw 48 movwf master_fail__test_number call master_fail ; if { temp != 1 } body end label373__0end: ; if exp=` temp != 1 ' empty false ; Other expression=`{ temp != 1 }' delay=-1 ; if { temp != 1 } end ; Bit clear : ; call slave_send {{ 0x40 | bit }} movlw 64 iorwf test__bit,w movwf slave_send__data call slave_send ; call test_verify {{ 0 , 0 }} clrf test_verify__high clrf test_verify__low call test_verify ; Read the bit again : ; call slave_send {{ 0x70 | bit }} movlw 112 iorwf test__bit,w movwf slave_send__data call slave_send ; temp := slave_get {{ }} call slave_get movf slave_get__0return__byte,w movwf test__temp ; if { temp != 0 } start ; expression=`{ temp != 0 }' exp_delay=1 true_delay=4 false_delay=0 true_size=8 false_size=0 btfsc z___byte,z___bit goto label385__0end ; if { temp != 0 } body start ; call master_octal {{ temp }} movf test__temp,w movwf master_octal__number call master_octal ; call master_fail {{ bit_string , 0x31 }} movlw LOW bit_string+1 movwf master_fail__test_name movlw 49 movwf master_fail__test_number call master_fail ; if { temp != 0 } body end label385__0end: ; if exp=` temp != 0 ' empty false ; Other expression=`{ temp != 0 }' delay=-1 ; if { temp != 0 } end ; Bit toggle : ; call slave_send {{ 0x60 | bit }} movlw 96 iorwf test__bit,w movwf slave_send__data call slave_send ; call test_verify {{ high , low }} movf test__high,w movwf test_verify__high movf test__low,w movwf test_verify__low call test_verify ; Bit toggle again : ; call slave_send {{ 0x60 | bit }} movlw 96 iorwf test__bit,w movwf slave_send__data call slave_send ; call test_verify {{ 0 , 0 }} clrf test_verify__high clrf test_verify__low call test_verify ; if { low @ 4 } start ; Alias variable for select low @ 4 test__low__398select0 equ test__low+0 test__low__398select0__byte equ test__low+0 test__low__398select0__bit equ 4 ; expression=`{ low @ 4 }' exp_delay=0 true_delay=3 false_delay=4 true_size=3 false_size=4 btfss test__low__398select0__byte,test__low__398select0__bit goto label398__1false label398__1true: ; if { low @ 4 } body start ; high := 1 movlw 1 movwf test__high ; low := 0 clrf test__low ; if { low @ 4 } body end goto label398__1end label398__1false: ; else body start ; high := high << 1 bcf c___byte,c___bit rlf test__high,f ; low := low << 1 bcf c___byte,c___bit rlf test__low,f ; else body end ; if exp=` low @ 4 ' generic label398__1end: ; Other expression=`{ low @ 4 }' delay=-1 ; if { low @ 4 } end ; bit := bit + 1 incf test__bit,f goto test__365while__continue ; if exp=` bit < 10 ' false goto ; Other expression=` bit < 10 ' delay=-1 test__365while__break: ; `while bit < 10 ...' end ; Now do some blink rate tests : ; First turn the bits on : ; call slave_send {{ 0x1f }} movlw 31 movwf slave_send__data call slave_send ; call slave_send {{ 0x3f }} movlw 63 movwf slave_send__data call slave_send ; bit := 0 clrf test__bit ; `while bit < 10 ...' start test__413while__continue: movlw 10 subwf test__bit,w ; expression=` bit < 10 ' exp_delay=2 true_delay=1 false_delay=2 true_size=35 false_size=1 btfsc c___byte,c___bit goto test__413while__break ; Set the blink rate : ; call slave_send {{ 0x83 }} movlw 131 movwf slave_send__data call slave_send ; call slave_send {{ {{ bit << 5 }} | bit }} swapf test__bit,w movwf test__416byte0 rlf test__416byte0,w andlw 224 iorwf test__bit,w movwf slave_send__data call slave_send ; Read the blink rate back : ; call slave_send {{ 0x70 | bit }} movlw 112 iorwf test__bit,w movwf slave_send__data call slave_send ; temp := slave_get {{ }} call slave_get movf slave_get__0return__byte,w movwf test__temp ; if { temp != {{ bit << 5 }} | 1 } start swapf test__bit,w movwf test__421byte0 rlf test__421byte0,w andlw 224 iorlw 1 subwf test__temp,w ; expression=`{ temp != {{ bit << 5 }} | 1 }' exp_delay=6 true_delay=4 false_delay=0 true_size=8 false_size=0 btfsc z___byte,z___bit goto label421__1end ; if { temp != {{ bit << 5 }} | 1 } body start ; call master_octal {{ temp }} movf test__temp,w movwf master_octal__number call master_octal ; call master_fail {{ blink_string , 0x32 }} movlw LOW blink_string+1 movwf master_fail__test_name movlw 50 movwf master_fail__test_number call master_fail ; if { temp != {{ bit << 5 }} | 1 } body end label421__1end: ; if exp=` temp != {{ bit << 5 }} | 1 ' empty false ; Other expression=`{ temp != {{ bit << 5 }} | 1 }' delay=-1 ; if { temp != {{ bit << 5 }} | 1 } end ; bit := bit + 1 incf test__bit,f goto test__413while__continue ; if exp=` bit < 10 ' false goto ; Other expression=` bit < 10 ' delay=-1 test__413while__break: ; `while bit < 10 ...' end ; Now turn the bits on and let them blink : ; call test_prompt {{ 0x1f , 0x1f }} movlw 31 movwf test_prompt__high movlw 31 movwf test_prompt__low call test_prompt ; Now clear the blink rates : ; bit := 0 clrf test__bit ; `while bit < 10 ...' start test__432while__continue: movlw 10 subwf test__bit,w ; expression=` bit < 10 ' exp_delay=2 true_delay=5 false_delay=2 true_size=8 false_size=1 btfsc c___byte,c___bit goto test__432while__break ; Clear the blink rate : ; call slave_send {{ 0x83 }} movlw 131 movwf slave_send__data call slave_send ; call slave_send {{ bit }} movf test__bit,w movwf slave_send__data call slave_send ; bit := bit + 1 incf test__bit,f goto test__432while__continue ; if exp=` bit < 10 ' false goto ; Other expression=` bit < 10 ' delay=-1 test__432while__break: ; `while bit < 10 ...' end ; Clear the bits : ; call slave_send {{ 0 }} clrf slave_send__data call slave_send ; call slave_send {{ 0x20 }} movlw 32 movwf slave_send__data call slave_send ; Now test increment : ; high := 0 clrf test__high ; `while high < 0x20 ...' start test__444while__continue: movlw 32 subwf test__high,w ; expression=` high < 0x20 ' exp_delay=2 true_delay=1 false_delay=2 true_size=17 false_size=1 btfsc c___byte,c___bit goto test__444while__break ; low := 0 clrf test__low ; `while low < 0x20 ...' start test__446while__continue: movlw 32 subwf test__low,w ; expression=` low < 0x20 ' exp_delay=2 true_delay=7 false_delay=2 true_size=10 false_size=1 btfsc c___byte,c___bit goto test__446while__break ; call test_verify {{ high , low }} movf test__high,w movwf test_verify__high movf test__low,w movwf test_verify__low call test_verify ; Now increment the LED ' s : ; call slave_send {{ 0x90 }} movlw 144 movwf slave_send__data call slave_send ; low := low + 1 incf test__low,f goto test__446while__continue ; if exp=` low < 0x20 ' false goto ; Other expression=` low < 0x20 ' delay=-1 test__446while__break: ; `while low < 0x20 ...' end ; high := high + 1 incf test__high,f goto test__444while__continue ; if exp=` high < 0x20 ' false goto ; Other expression=` high < 0x20 ' delay=-1 test__444while__break: ; `while high < 0x20 ...' end ; Now test decrement : ; high := 0x20 movlw 32 movwf test__high ; `while high != 0 ...' start test__458while__continue: movf test__high,w ; expression=` high != 0 ' exp_delay=1 true_delay=1 false_delay=2 true_size=17 false_size=1 btfsc z___byte,z___bit goto test__458while__break ; high := high - 1 decf test__high,f ; low := 0x20 movlw 32 movwf test__low ; `while low != 0 ...' start test__461while__continue: movf test__low,w ; expression=` low != 0 ' exp_delay=1 true_delay=7 false_delay=2 true_size=10 false_size=1 btfsc z___byte,z___bit goto test__461while__break ; low := low - 1 decf test__low,f ; Now decrement the LED ' s : ; call slave_send {{ 0xa0 }} movlw 160 movwf slave_send__data call slave_send ; Now verify : ; call test_verify {{ high , low }} movf test__high,w movwf test_verify__high movf test__low,w movwf test_verify__low call test_verify goto test__461while__continue ; if exp=` low != 0 ' false goto ; Other expression=` low != 0 ' delay=-1 test__461while__break: ; `while low != 0 ...' end goto test__458while__continue ; if exp=` high != 0 ' false goto ; Other expression=` high != 0 ' delay=-1 test__458while__break: ; `while high != 0 ...' end ; Test power level : ; high := 0 clrf test__high ; low := 0 clrf test__low ; level := 0 clrf test__level ; `while level <= 10 ...' start test__475while__continue: movlw 11 subwf test__level,w ; expression=` level <= 10 ' exp_delay=2 true_delay=1 false_delay=2 true_size=22 false_size=1 btfsc c___byte,c___bit goto test__475while__break ; call slave_send {{ 0xb0 | level }} movlw 176 iorwf test__level,w movwf slave_send__data call slave_send ; call test_verify {{ high , low }} movf test__high,w movwf test_verify__high movf test__low,w movwf test_verify__low call test_verify ; if { low @ 4 } start ; Alias variable for select low @ 4 test__low__478select0 equ test__low+0 test__low__478select0__byte equ test__low+0 test__low__478select0__bit equ 4 ; expression=`{ low @ 4 }' exp_delay=0 true_delay=4 false_delay=4 true_size=4 false_size=4 btfss test__low__478select0__byte,test__low__478select0__bit goto label478__1false label478__1true: ; if { low @ 4 } body start ; high := {{ high << 1 }} | 1 bcf c___byte,c___bit rlf test__high,w iorlw 1 movwf test__high ; if { low @ 4 } body end goto label478__1end label478__1false: ; else body start ; low := {{ low << 1 }} | 1 bcf c___byte,c___bit rlf test__low,w iorlw 1 movwf test__low ; else body end ; if exp=` low @ 4 ' generic label478__1end: ; Other expression=`{ low @ 4 }' delay=-1 ; if { low @ 4 } end ; level := level + 1 incf test__level,f goto test__475while__continue ; if exp=` level <= 10 ' false goto ; Other expression=` level <= 10 ' delay=-1 test__475while__break: ; `while level <= 10 ...' end ; Let ' s clear the LED ' s : ; call slave_send {{ 0 }} clrf slave_send__data call slave_send ; call slave_send {{ 0x20 }} movlw 32 movwf slave_send__data call slave_send ; Announce that we are done : ; call master_string {{ done_string }} movlw LOW done_string+1 movwf master_string__message call master_string ; call master_crlf {{ }} call master_crlf ; procedure test end retlw 0 ; procedure test_verify start test_verify: test_verify__variables__base equ global__variables__bank0+25 test_verify__bytes__base equ test_verify__variables__base+0 test_verify__bits__base equ test_verify__variables__base+3 test_verify__total__bytes equ 3 test_verify__high equ test_verify__bytes__base+0 test_verify__low equ test_verify__bytes__base+1 ; This procedure will verify that the registers contain high and low . test_verify__temp equ test_verify__bytes__base+2 ; Read low register : ; call slave_send {{ 0x81 }} movlw 129 movwf slave_send__data call slave_send ; temp := slave_get {{ }} call slave_get movf slave_get__0return__byte,w movwf test_verify__temp ; if { temp != low } start subwf test_verify__low,w ; expression=`{ temp != low }' exp_delay=2 true_delay=3 false_delay=0 true_size=5 false_size=0 btfsc z___byte,z___bit goto label507__0end ; if { temp != low } body start ; call master_fail {{ read_string , 0x50 }} movlw LOW read_string+1 movwf master_fail__test_name movlw 80 movwf master_fail__test_number call master_fail ; if { temp != low } body end label507__0end: ; if exp=` temp != low ' empty false ; Other expression=`{ temp != low }' delay=-1 ; if { temp != low } end ; Read high register : ; call slave_send {{ 0x82 }} movlw 130 movwf slave_send__data call slave_send ; temp := slave_get {{ }} call slave_get movf slave_get__0return__byte,w movwf test_verify__temp ; if { temp != high } start subwf test_verify__high,w ; expression=`{ temp != high }' exp_delay=2 true_delay=5 false_delay=0 true_size=11 false_size=0 btfsc z___byte,z___bit goto label514__0end ; if { temp != high } body start ; call master_octal {{ temp }} movf test_verify__temp,w movwf master_octal__number call master_octal ; call master_octal {{ high }} movf test_verify__high,w movwf master_octal__number call master_octal ; call master_fail {{ read_string , 0x51 }} movlw LOW read_string+1 movwf master_fail__test_name movlw 81 movwf master_fail__test_number call master_fail ; if { temp != high } body end label514__0end: ; if exp=` temp != high ' empty false ; Other expression=`{ temp != high }' delay=-1 ; if { temp != high } end ; procedure test_verify end retlw 0 ; procedure test_prompt start test_prompt: test_prompt__variables__base equ global__variables__bank0+28 test_prompt__bytes__base equ test_prompt__variables__base+0 test_prompt__bits__base equ test_prompt__variables__base+5 test_prompt__total__bytes equ 5 test_prompt__550byte0 equ test_prompt__bytes__base+4 test_prompt__high equ test_prompt__bytes__base+0 test_prompt__low equ test_prompt__bytes__base+1 ; This procedure will prompt the user to input a paticular pattern : test_prompt__count equ test_prompt__bytes__base+2 test_prompt__char equ test_prompt__bytes__base+3 ; Print high order pattern : ; `count_down count 5 ...' start movlw 5 movwf test_prompt__count test_prompt__532_loop: ; char := 0c'.' movlw 46 movwf test_prompt__char ; if { high @ 4 } start ; Alias variable for select high @ 4 test_prompt__high__534select0 equ test_prompt__high+0 test_prompt__high__534select0__byte equ test_prompt__high+0 test_prompt__high__534select0__bit equ 4 ; expression=`{ high @ 4 }' exp_delay=0 true_delay=2 false_delay=0 true_size=2 false_size=0 btfss test_prompt__high__534select0__byte,test_prompt__high__534select0__bit goto label534__1end ; if { high @ 4 } body start ; char := 0c'*' movlw 42 movwf test_prompt__char ; if { high @ 4 } body end label534__1end: ; if exp=` high @ 4 ' empty false ; Other expression=`{ high @ 4 }' delay=-1 ; if { high @ 4 } end ; call master_send {{ char }} movf test_prompt__char,w movwf master_send__character call master_send ; high := high << 1 bcf c___byte,c___bit rlf test_prompt__high,f decfsz test_prompt__count,f goto test_prompt__532_loop test_prompt__532_done: ; `count_down count 5 ...' end ; `count_down count 5 ...' start movlw 5 movwf test_prompt__count test_prompt__540_loop: ; char := 0c'.' movlw 46 movwf test_prompt__char ; if { low @ 4 } start ; Alias variable for select low @ 4 test_prompt__low__542select0 equ test_prompt__low+0 test_prompt__low__542select0__byte equ test_prompt__low+0 test_prompt__low__542select0__bit equ 4 ; expression=`{ low @ 4 }' exp_delay=0 true_delay=2 false_delay=0 true_size=2 false_size=0 btfss test_prompt__low__542select0__byte,test_prompt__low__542select0__bit goto label542__1end ; if { low @ 4 } body start ; char := 0c'*' movlw 42 movwf test_prompt__char ; if { low @ 4 } body end label542__1end: ; if exp=` low @ 4 ' empty false ; Other expression=`{ low @ 4 }' delay=-1 ; if { low @ 4 } end ; call master_send {{ char }} movf test_prompt__char,w movwf master_send__character call master_send ; low := low << 1 bcf c___byte,c___bit rlf test_prompt__low,f decfsz test_prompt__count,f goto test_prompt__540_loop test_prompt__540_done: ; `count_down count 5 ...' end ; call master_send {{ 0c':' }} movlw 58 movwf master_send__character call master_send ; `while master_get ## {{ }} = 0xfc ...' start test_prompt__550while__continue: call master_get movf master_get__0return__byte,w movwf test_prompt__550byte0 movlw 252 subwf test_prompt__550byte0,w ; expression=` master_get ## {{ }} = 0xfc ' exp_delay=3 true_delay=2 false_delay=2 true_size=1 false_size=1 btfsc z___byte,z___bit ; Do nothing : goto test_prompt__550while__continue goto test_prompt__550while__break ; if exp=` master_get ## {{ }} = 0xfc ' true goto small true test_prompt__550while__break: ; `while master_get ## {{ }} = 0xfc ...' end ; call master_crlf {{ }} call master_crlf ; procedure test_prompt end retlw 0 ; comment {The procedures below are used to test the common shared commands :} ; procedure common_test start common_test: common_test__variables__base equ global__variables__bank0+33 common_test__bytes__base equ common_test__variables__base+0 common_test__bits__base equ common_test__variables__base+2 common_test__total__bytes equ 2 common_test__601byte0 equ common_test__bytes__base+1 ; arguments_none ; This procedure will verify that the common shared commands work . common_test__actual equ common_test__bytes__base+0 ; Print the ID information : ; ID reset : ; call slave_send {{ 0xfd }} movlw 253 movwf slave_send__data call slave_send ; Read the fixed bytes : ; call common_test_id_match {{ 1 , 0xc0 }} movlw 1 movwf common_test_id_match__desired movlw 192 movwf common_test_id_match__test_number call common_test_id_match ; call common_test_id_match {{ 0 , 0xc1 }} clrf common_test_id_match__desired movlw 193 movwf common_test_id_match__test_number call common_test_id_match ; call common_test_id_match {{ 9 , 0xc2 }} movlw 9 movwf common_test_id_match__desired movlw 194 movwf common_test_id_match__test_number call common_test_id_match ; call common_test_id_match {{ 0 , 0xc3 }} clrf common_test_id_match__desired movlw 195 movwf common_test_id_match__test_number call common_test_id_match ; call common_test_id_match {{ 0 , 0xc4 }} clrf common_test_id_match__desired movlw 196 movwf common_test_id_match__test_number call common_test_id_match ; call common_test_id_match {{ 0 , 0xc5 }} clrf common_test_id_match__desired movlw 197 movwf common_test_id_match__test_number call common_test_id_match ; call common_test_id_match {{ 0 , 0xc6 }} clrf common_test_id_match__desired movlw 198 movwf common_test_id_match__test_number call common_test_id_match ; call common_test_id_match {{ 0 , 0xc7 }} clrf common_test_id_match__desired movlw 199 movwf common_test_id_match__test_number call common_test_id_match ; call master_crlf {{ }} call master_crlf ; call common_test_id_bytes8 {{ }} call common_test_id_bytes8 ; call common_test_id_bytes8 {{ }} call common_test_id_bytes8 ; Read the brick name : ; call common_test_id_string {{ }} call common_test_id_string ; Read the vendor name : ; call common_test_id_string {{ }} call common_test_id_string ; Verfify that we don ' t read off the end of the id and crash : ; call common_test_id_next {{ }} call common_test_id_next movf common_test_id_next__0return__byte,w ; Reset id : ; call slave_send {{ 0xfd }} movlw 253 movwf slave_send__data call slave_send ; Verify that we are still alive : ; call common_test_id_match {{ 1 , 0xc8 }} movlw 1 movwf common_test_id_match__desired movlw 200 movwf common_test_id_match__test_number call common_test_id_match ; Read glitch : ; Clear glitch register : ; call slave_send {{ 0xfe }} movlw 254 movwf slave_send__data call slave_send ; actual := slave_get {{ }} call slave_get movf slave_get__0return__byte,w movwf common_test__actual ; Send a couple of glitches : ; call slave_send {{ 0xff }} movlw 255 movwf slave_send__data call slave_send ; call slave_send {{ 0xff }} movlw 255 movwf slave_send__data call slave_send ; Read the glitch register : ; call slave_send {{ 0xfe }} movlw 254 movwf slave_send__data call slave_send ; if { slave_get {{ }} != 2 } start call slave_get movf slave_get__0return__byte,w movwf common_test__601byte0 movlw 2 subwf common_test__601byte0,w ; expression=`{ slave_get {{ }} != 2 }' exp_delay=3 true_delay=3 false_delay=0 true_size=5 false_size=0 btfsc z___byte,z___bit goto label601__1end ; if { slave_get {{ }} != 2 } body start ; call master_fail {{ common_string , 0xc9 }} movlw LOW common_string+1 movwf master_fail__test_name movlw 201 movwf master_fail__test_number call master_fail ; if { slave_get {{ }} != 2 } body end label601__1end: ; if exp=` slave_get ## {{ }} != 2 ' empty false ; Other expression=`{ slave_get {{ }} != 2 }' delay=-1 ; if { slave_get {{ }} != 2 } end ; Do a clock pulse : ; call slave_send {{ 0xfb }} movlw 251 movwf slave_send__data call slave_send ; if { slave_get {{ }} != 0 } start call slave_get movf slave_get__0return__byte,w ; expression=`{ slave_get {{ }} != 0 }' exp_delay=0 true_delay=3 false_delay=0 true_size=5 false_size=0 btfsc z___byte,z___bit goto label607__0end ; if { slave_get {{ }} != 0 } body start ; call master_fail {{ common_string , 0xca }} movlw LOW common_string+1 movwf master_fail__test_name movlw 202 movwf master_fail__test_number call master_fail ; if { slave_get {{ }} != 0 } body end label607__0end: ; if exp=` slave_get ## {{ }} != 0 ' empty false ; Other expression=`{ slave_get {{ }} != 0 }' delay=-1 ; if { slave_get {{ }} != 0 } end ; Read clock : ; call slave_send {{ 0xfa }} movlw 250 movwf slave_send__data call slave_send ; actual := slave_get {{ }} call slave_get movf slave_get__0return__byte,w movwf common_test__actual ; Increment : ; call slave_send {{ 0xf9 }} movlw 249 movwf slave_send__data call slave_send ; Decrement : ; call slave_send {{ 0xf8 }} movlw 248 movwf slave_send__data call slave_send ; Read clock again : ; call slave_send {{ 0xfa }} movlw 250 movwf slave_send__data call slave_send ; if { actual != slave_get {{ }} } start call slave_get movf slave_get__0return__byte,w subwf common_test__actual,w ; expression=`{ actual != slave_get {{ }} }' exp_delay=1 true_delay=3 false_delay=0 true_size=5 false_size=0 btfsc z___byte,z___bit goto label619__0end ; if { actual != slave_get {{ }} } body start ; call master_fail {{ common_string , 0xcb }} movlw LOW common_string+1 movwf master_fail__test_name movlw 203 movwf master_fail__test_number call master_fail ; if { actual != slave_get {{ }} } body end label619__0end: ; if exp=` actual != slave_get ## {{ }} ' empty false ; Other expression=`{ actual != slave_get {{ }} }' delay=-1 ; if { actual != slave_get {{ }} } end ; procedure common_test end retlw 0 ; procedure common_test_id_match start common_test_id_match: common_test_id_match__variables__base equ global__variables__bank0+35 common_test_id_match__bytes__base equ common_test_id_match__variables__base+0 common_test_id_match__bits__base equ common_test_id_match__variables__base+2 common_test_id_match__total__bytes equ 2 common_test_id_match__desired equ common_test_id_match__bytes__base+0 common_test_id_match__test_number equ common_test_id_match__bytes__base+1 ; This procedure will verify that the next byte in the id is < desired > . ; if { desired != common_test_id_next {{ }} } start call common_test_id_next movf common_test_id_next__0return__byte,w subwf common_test_id_match__desired,w ; expression=`{ desired != common_test_id_next {{ }} }' exp_delay=1 true_delay=3 false_delay=0 true_size=5 false_size=0 btfsc z___byte,z___bit goto label631__0end ; if { desired != common_test_id_next {{ }} } body start ; call master_fail {{ common_string , test_number }} movlw LOW common_string+1 movwf master_fail__test_name movf common_test_id_match__test_number,w movwf master_fail__test_number call master_fail ; if { desired != common_test_id_next {{ }} } body end label631__0end: ; if exp=` desired != common_test_id_next ## {{ }} ' empty false ; Other expression=`{ desired != common_test_id_next {{ }} }' delay=-1 ; if { desired != common_test_id_next {{ }} } end ; procedure common_test_id_match end retlw 0 ; procedure common_test_id_bytes8 start common_test_id_bytes8: common_test_id_bytes8__variables__base equ global__variables__bank0+37 common_test_id_bytes8__bytes__base equ common_test_id_bytes8__variables__base+0 common_test_id_bytes8__bits__base equ common_test_id_bytes8__variables__base+1 common_test_id_bytes8__total__bytes equ 1 ; arguments_none ; This procedure will print out the next 8 bytes of the id in octal . common_test_id_bytes8__count equ common_test_id_bytes8__bytes__base+0 ; `count_down count 8 ...' start movlw 8 movwf common_test_id_bytes8__count common_test_id_bytes8__644_loop: ; call master_octal {{ common_test_id_next {{ }} }} call common_test_id_next movf common_test_id_next__0return__byte,w movwf master_octal__number call master_octal decfsz common_test_id_bytes8__count,f goto common_test_id_bytes8__644_loop common_test_id_bytes8__644_done: ; `count_down count 8 ...' end ; call master_crlf {{ }} call master_crlf ; procedure common_test_id_bytes8 end retlw 0 ; procedure common_test_id_string start common_test_id_string: common_test_id_string__variables__base equ global__variables__bank0+38 common_test_id_string__bytes__base equ common_test_id_string__variables__base+0 common_test_id_string__bits__base equ common_test_id_string__variables__base+1 common_test_id_string__total__bytes equ 1 ; arguments_none ; This procedure will print out the next id string . common_test_id_string__count equ common_test_id_string__bytes__base+0 ; `count_down count common_test_id_next ## {{ }} ...' start call common_test_id_next movf common_test_id_next__0return__byte,w movwf common_test_id_string__count common_test_id_string__658_loop: ; call master_send {{ common_test_id_next {{ }} }} call common_test_id_next movf common_test_id_next__0return__byte,w movwf master_send__character call master_send decfsz common_test_id_string__count,f goto common_test_id_string__658_loop common_test_id_string__658_done: ; `count_down count common_test_id_next ## {{ }} ...' end ; call master_crlf {{ }} call master_crlf ; procedure common_test_id_string end retlw 0 ; procedure common_test_id_next start common_test_id_next: common_test_id_next__variables__base equ global__variables__bank0+39 common_test_id_next__bytes__base equ common_test_id_next__variables__base+0 common_test_id_next__bits__base equ common_test_id_next__variables__base+1 common_test_id_next__total__bytes equ 1 ; arguments_none common_test_id_next__0return__byte equ common_test_id_next__bytes__base+0 ; This procedure returns the next byte from the identification string . ; call slave_send {{ 0xfc }} movlw 252 movwf slave_send__data call slave_send ; return slave_get {{ }} call slave_get movf slave_get__0return__byte,w movwf common_test_id_next__0return__byte retlw 0 ; procedure common_test_id_next end ; comment {The following procedures are used to communicate with the master :} ; procedure master_crlf start master_crlf: master_crlf__variables__base equ global__variables__bank0+40 master_crlf__bytes__base equ master_crlf__variables__base+0 master_crlf__bits__base equ master_crlf__variables__base+0 master_crlf__total__bytes equ 0 ; arguments_none ; This procedure will output a carriage - return line - feed ; to the master . ; call master_send {{ cr }} movlw 13 movwf master_send__character call master_send ; call master_send {{ lf }} movlw 10 movwf master_send__character call master_send ; procedure master_crlf end retlw 0 ; procedure master_fail start master_fail: master_fail__variables__base equ global__variables__bank0+40 master_fail__bytes__base equ master_fail__variables__base+0 master_fail__bits__base equ master_fail__variables__base+2 master_fail__total__bytes equ 2 master_fail__test_name equ master_fail__bytes__base+0 master_fail__test_number equ master_fail__bytes__base+1 ; This procedure will output ` fail ' followed by a carriage return ; and line feed . ; call master_string {{ fail_string }} movlw LOW fail_string+1 movwf master_string__message call master_string ; call master_string {{ test_name }} movf master_fail__test_name,w movwf master_string__message call master_string ; call master_octal {{ test_number }} movf master_fail__test_number,w movwf master_octal__number call master_octal ; call master_crlf {{ }} call master_crlf ; procedure master_fail end retlw 0 ; procedure master_get start master_get: master_get__variables__base equ global__variables__bank0+42 master_get__bytes__base equ master_get__variables__base+0 master_get__bits__base equ master_get__variables__base+1 master_get__total__bytes equ 1 ; arguments_none master_get__0return__byte equ master_get__bytes__base+0 ; This procedure will get the next byte or return 0xfc if ; no byte is forthcoming . ; return get_byte {{ rx_master_mask }} movlw 2 movwf get_byte__mask call get_byte movf get_byte__0return__byte,w movwf master_get__0return__byte retlw 0 ; procedure master_get end ; procedure master_octal start master_octal: master_octal__variables__base equ global__variables__bank0+43 master_octal__bytes__base equ master_octal__variables__base+0 master_octal__bits__base equ master_octal__variables__base+2 master_octal__total__bytes equ 2 master_octal__718byte0 equ master_octal__bytes__base+1 master_octal__719byte0 equ master_octal__bytes__base+1 master_octal__number equ master_octal__bytes__base+0 ; This procedure will output < number > in octal to the tx port . ; Output the character in octal : ; call master_send {{ {{ number >> 6 }} + 0c'0' }} swapf master_octal__number,w movwf master_octal__718byte0 rrf master_octal__718byte0,f rrf master_octal__718byte0,w andlw 3 addlw 48 movwf master_send__character call master_send ; call master_send {{ {{ {{ number >> 3 }} & 7 }} + 0c'0' }} rrf master_octal__number,w movwf master_octal__719byte0 rrf master_octal__719byte0,f rrf master_octal__719byte0,w andlw 7 addlw 48 movwf master_send__character call master_send ; call master_send {{ {{ number & 7 }} + 0c'0' }} movlw 7 andwf master_octal__number,w addlw 48 movwf master_send__character call master_send ; call master_send {{ sp }} movlw 32 movwf master_send__character call master_send ; procedure master_octal end retlw 0 ; procedure slave_get start slave_get: slave_get__variables__base equ global__variables__bank0+45 slave_get__bytes__base equ slave_get__variables__base+0 slave_get__bits__base equ slave_get__variables__base+1 slave_get__total__bytes equ 1 ; arguments_none slave_get__0return__byte equ slave_get__bytes__base+0 ; This procedure will get a byte from the slave or return 0xfc ; if no byte is forthcoming . ; return get_byte {{ rx_slave_mask }} movlw 32 movwf get_byte__mask call get_byte movf get_byte__0return__byte,w movwf slave_get__0return__byte retlw 0 ; procedure slave_get end ; procedure slave_send start slave_send: slave_send__variables__base equ global__variables__bank0+46 slave_send__bytes__base equ slave_send__variables__base+0 slave_send__bits__base equ slave_send__variables__base+1 slave_send__total__bytes equ 1 slave_send__data equ slave_send__bytes__base+0 ; This procedure will send one byte of < data > to the slave . ; call send_byte {{ data , tx_slave_mask }} movf slave_send__data,w movwf send_byte__char movlw 16 movwf send_byte__mask call send_byte ; procedure slave_send end retlw 0 ; comment {The last procedures do character sending and receiving :} ; procedure get_byte start get_byte: get_byte__variables__base equ global__variables__bank0+47 get_byte__bytes__base equ get_byte__variables__base+0 get_byte__bits__base equ get_byte__variables__base+4 get_byte__total__bytes equ 4 get_byte__mask equ get_byte__bytes__base+0 get_byte__0return__byte equ get_byte__bytes__base+1 ; Get an 8 - bit byte from < mask > bit of < portb > and return it . ; If no character shows up in a while 0xfc is returned . get_byte__count equ get_byte__bytes__base+2 get_byte__char equ get_byte__bytes__base+3 ; Wait until a start bit arrives : ; count := 0 clrf get_byte__count ; `while portb & mask != 0 ...' start get_byte__757while__continue: movf portb,w andwf get_byte__mask,w ; expression=` portb & mask != 0 ' exp_delay=2 true_delay=1 false_delay=2 true_size=9 false_size=1 btfsc z___byte,z___bit goto get_byte__757while__break ; count := count - 1 decf get_byte__count,f ; if { count = 0 } start movf get_byte__count,w ; expression=`{ count = 0 }' exp_delay=1 true_delay=3 false_delay=0 true_size=3 false_size=0 btfss z___byte,z___bit goto label759__0end ; if { count = 0 } body start ; return 0xfc movlw 252 movwf get_byte__0return__byte retlw 0 ; if { count = 0 } body end label759__0end: ; if exp=` count = 0 ' empty false ; Other expression=`{ count = 0 }' delay=-1 ; if { count = 0 } end ; call delay {{ }} call delay goto get_byte__757while__continue ; if exp=` portb & mask != 0 ' false goto ; Other expression=` portb & mask != 0 ' delay=-1 get_byte__757while__break: ; `while portb & mask != 0 ...' end ; Skip over the start bit : ; call delay {{ }} call delay ; call delay {{ }} call delay ; call delay {{ }} call delay ; Sample in the middle third of each data bit : ; char := 0 clrf get_byte__char ; `count_down count 8 ...' start movlw 8 movwf get_byte__count get_byte__772_loop: ; call delay {{ }} call delay ; 2 instructions : ; char := char >> 1 bcf c___byte,c___bit rrf get_byte__char,f ; 3 instruciions : ; if { portb & mask != 0 } start movf portb,w andwf get_byte__mask,w ; expression=`{ portb & mask != 0 }' exp_delay=2 true_delay=1 false_delay=0 true_size=1 false_size=0 btfss z___byte,z___bit ; if { portb & mask != 0 } body start ; char @ 7 := 1 ; Select char @ 7 get_byte__char__778select0 equ get_byte__char+0 get_byte__char__778select0__byte equ get_byte__char+0 get_byte__char__778select0__bit equ 7 bsf get_byte__char__778select0__byte,get_byte__char__778select0__bit ; if { portb & mask != 0 } body end ; if exp=` portb & mask != 0 ' false skip delay=4 ; Other expression=`{ portb & mask != 0 }' delay=4 ; if { portb & mask != 0 } end ; call delay {{ }} call delay ; call delay {{ }} call delay ; 3 more instructions at the end of the loop : ; 2 + 3 + 3 = 8 ; nop extra_instructions_per_bit - 8 ; Delay 4 cycles nop nop nop nop decfsz get_byte__count,f goto get_byte__772_loop get_byte__772_done: ; `count_down count 8 ...' end ; Skip over 2 / 3 of the stop bit : ; call delay {{ }} call delay ; call delay {{ }} call delay ; return char movf get_byte__char,w movwf get_byte__0return__byte retlw 0 ; procedure get_byte end ; procedure send_byte start send_byte: send_byte__variables__base equ global__variables__bank0+51 send_byte__bytes__base equ send_byte__variables__base+0 send_byte__bits__base equ send_byte__variables__base+4 send_byte__total__bytes equ 4 send_byte__char equ send_byte__bytes__base+0 send_byte__mask equ send_byte__bytes__base+1 ; Send < char > to < mask > bit of < portb > . send_byte__count equ send_byte__bytes__base+2 send_byte__mark equ send_byte__bytes__base+3 ; Send the start bit : ; 2 instructions : ; mark := mask ^ space movlw 255 xorwf send_byte__mask,w movwf send_byte__mark ; 2 instructions : ; portb := mark movwf portb ; call delay {{ }} call delay ; call delay {{ }} call delay ; call delay {{ }} call delay ; 2 instructions to set up loop : ; 2 + 2 + 2 = 6 ; nop extra_instructions_per_bit - 6 ; Delay 6 cycles nop nop nop nop nop nop ; Send the data : ; `count_down count 8 ...' start movlw 8 movwf send_byte__count send_byte__818_loop: ; 5 Instructions : ; if { char @ 0 } start ; Alias variable for select char @ 0 send_byte__char__820select0 equ send_byte__char+0 send_byte__char__820select0__byte equ send_byte__char+0 send_byte__char__820select0__bit equ 0 ; expression=`{ char @ 0 }' exp_delay=0 true_delay=1 false_delay=1 true_size=1 false_size=1 btfsc send_byte__char__820select0__byte,send_byte__char__820select0__bit ; if { char @ 0 } body start ; portb := space movlw 255 ; 1 instructions found for sharing btfss send_byte__char__820select0__byte,send_byte__char__820select0__bit ; else body start ; portb := mark movf send_byte__mark,w ; 1 instructions found for sharing ; if exp=` char @ 0 ' single true and false skip delay=4 ; Other expression=`{ char @ 0 }' delay=4 ; 1 shared instructions follow movwf portb ; if { char @ 0 } end ; 2 Instructions : ; char := char >> 1 bcf c___byte,c___bit rrf send_byte__char,f ; call delay {{ }} call delay ; call delay {{ }} call delay ; call delay {{ }} call delay ; 3 instructions for test and jump at end of loop ; 2 + 3 + 5 = 10 ; nop extra_instructions_per_bit - 10 ; Delay 2 cycles nop nop decfsz send_byte__count,f goto send_byte__818_loop send_byte__818_done: ; `count_down count 8 ...' end ; Send the stop bit : ; portb := space movlw 255 movwf portb ; call delay {{ }} call delay ; call delay {{ }} call delay ; call delay {{ }} call delay ; + 1 = > NOP to finish loop ; - 2 = > portb := space ; - 4 = > call / return ; - 4 = > two arguments . ; nop extra_instructions_per_bit + 1 - 2 - 4 - 4 ; Delay 3 cycles nop nop nop ; procedure send_byte end retlw 0 ; procedure master_send start master_send: master_send__variables__base equ global__variables__bank0+55 master_send__bytes__base equ master_send__variables__base+0 master_send__bits__base equ master_send__variables__base+1 master_send__total__bytes equ 1 master_send__character equ master_send__bytes__base+0 ; This procedure will output < character > to the master . ; call send_byte {{ character , tx_master_mask }} movf master_send__character,w movwf send_byte__char movlw 4 movwf send_byte__mask call send_byte ; procedure master_send end retlw 0 ; procedure master_string start master_string: master_string__variables__base equ global__variables__bank0+56 master_string__bytes__base equ master_string__variables__base+0 master_string__bits__base equ master_string__variables__base+3 master_string__total__bytes equ 3 master_string__message equ master_string__bytes__base+0 ; This procedure will output < message > to the master . master_string__size equ master_string__bytes__base+1 master_string__index equ master_string__bytes__base+2 ; index := 0 clrf master_string__index ; `while index < message . size ...' start master_string__866while__continue: clrf pclath___register movf master_string__message,w call string___fetch subwf master_string__index,w ; expression=` index < message . size ' exp_delay=4 true_delay=7 false_delay=2 true_size=8 false_size=1 btfsc c___byte,c___bit goto master_string__866while__break ; call master_send {{ message ~~ {{ index }} }} incf master_string__index,w addwf master_string__message,w clrf pclath___register call string___fetch movwf master_send__character call master_send ; index := index + 1 incf master_string__index,f goto master_string__866while__continue ; if exp=` index < message . size ' false goto ; Other expression=` index < message . size ' delay=-1 master_string__866while__break: ; `while index < message . size ...' end ; call master_send {{ sp }} movlw 32 movwf master_send__character call master_send ; procedure master_string end retlw 0 ; procedure delay start ; optimize 0 delay: delay__variables__base equ global__variables__bank0+59 delay__bytes__base equ delay__variables__base+0 delay__bits__base equ delay__variables__base+1 delay__total__bytes equ 1 delay__873byte1 equ delay__bytes__base+0 ; arguments_none ; uniform_delay delay_instructions ; Uniform delay remaining = 339 Accumulated Delay = 0 ; Uniform delay remaining = 339 Accumulated Delay = 0 ; Delay 1 third of a bit : ; Uniform delay remaining = 339 Accumulated Delay = 0 ; Uniform delay remaining = 339 Accumulated Delay = 0 ; Soak up remaining 339 cycles ; Delay 339 cycles movlw 112 movwf delay__873byte1 delay__873delay0: decfsz delay__873byte1,f goto delay__873delay0 nop nop ; procedure delay end retlw 0 ; optimize 1 ; Register bank 0 used 60 bytes of 96 available bytes ; Register bank 1 used 0 bytes of 80 available bytes ; Register bank 2 used 0 bytes of 48 available bytes ; Register bank 3 used 0 bytes of 0 available bytes end