aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Tools: RCInput_UART PIC firmware: blink status led when idle

Browse Source 
Blink status led if there's no input in more than (2 * NUM_INPUT) ms. That's
useful to show the user that the program is working, but not receiving proper
input.
This commit is contained in:
Gustavo Jose de Sousa 2015-10-05 20:18:16 -03:00 committed by Andrew Tridgell
parent 6a8420aa48
commit 2c9472c634
1 changed files with 22 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
Tools/Linux_HAL_Essentials/RCInput_UART/pic_firmware.asm
View File

@ -52,6 +52,7 @@
timer_l timer_l
timer_h timer_h
count count
tmr1if_count
endc endc
cblock 0x0a0 cblock 0x0a0
@ -276,12 +277,32 @@ Main:
movlw (1<<GIE|1<<PEIE|1<<RABIE) movlw (1<<GIE|1<<PEIE|1<<RABIE)
movwf INTCON movwf INTCON
MainLoopNoUpdate:
; toggle status led if idle for more than INPUT_NUM * 2000 usec
movf timer_h, w
subwf TMR1H, w
sublw high(.2000 * INPUT_NUM)
btfsc STATUS, C
goto MainLoop
; toggle status led at each 8 timer1 overflows, i.e., about 0.52 sec
btfss PIR1, TMR1IF
goto MainLoop
bcf PIR1, TMR1IF
incf tmr1if_count, f
movlw H'07'
andwf tmr1if_count, w
btfss STATUS, Z
goto MainLoop
; toggle status led
movf PORTC, w
xorlw (1<<RC1)
movwf PORTC
MainLoop: MainLoop:
; loop if no updates ; loop if no updates
movf sent_update, w movf sent_update, w
subwf input_updated, w subwf input_updated, w
btfsc STATUS, Z btfsc STATUS, Z
goto MainLoop goto MainLoopNoUpdate
; prepare for mirroring ; prepare for mirroring
addwf sent_update, f addwf sent_update, f