valsched: use cbr and sbr.
This commit is contained in:
@@ -86,13 +86,13 @@ ValueScheduler_Every100ms:
|
||||
; interval finished, check for repeat
|
||||
ldd r17, Y+VALSCHED_OFFS_FLAGS
|
||||
clr r16
|
||||
sbrs r16, VALSCHED_FLAGS_REPEAT_BIT
|
||||
dec r17 ; bit not set, stop counter after this interval
|
||||
std Y+VALSCHED_OFFS_TIMER, r17
|
||||
sbrs r17, VALSCHED_FLAGS_REPEAT_BIT
|
||||
dec r16 ; bit not set, stop counter after this interval
|
||||
std Y+VALSCHED_OFFS_TIMER, r16
|
||||
rjmp ValueScheduler_Every100ms_end
|
||||
ValueScheduler_Every100ms_setSendFlag:
|
||||
ldd r16, Y+VALSCHED_OFFS_FLAGS
|
||||
ori r16, (1<<VALSCHED_FLAGS_TOSEND_BIT)
|
||||
sbr r16, (1<<VALSCHED_FLAGS_TOSEND_BIT)
|
||||
std Y+VALSCHED_OFFS_FLAGS, r16
|
||||
ValueScheduler_Every100ms_end:
|
||||
ret
|
||||
@@ -111,10 +111,9 @@ ValueScheduler_Every100ms_end:
|
||||
|
||||
ValueScheduler_CheckSend:
|
||||
ldd r16, Y+VALSCHED_OFFS_FLAGS
|
||||
andi r16, (1<<VALSCHED_FLAGS_TOSEND_BIT)
|
||||
breq ValueScheduler_CheckSend_end
|
||||
sec
|
||||
ValueScheduler_CheckSend_end:
|
||||
sbrs r16, VALSCHED_FLAGS_TOSEND_BIT
|
||||
clc
|
||||
ret
|
||||
; @end
|
||||
|
||||
@@ -130,7 +129,7 @@ ValueScheduler_CheckSend_end:
|
||||
|
||||
ValueScheduler_MarkSent:
|
||||
ldd r16, Y+VALSCHED_OFFS_FLAGS
|
||||
andi r16, ~(1<<VALSCHED_FLAGS_TOSEND_BIT)
|
||||
cbr r16, (1<<VALSCHED_FLAGS_TOSEND_BIT)
|
||||
std Y+VALSCHED_OFFS_FLAGS, r16
|
||||
ret
|
||||
; @end
|
||||
@@ -147,32 +146,38 @@ ValueScheduler_MarkSent:
|
||||
; @clobbers r17
|
||||
|
||||
ValueScheduler_SetValue:
|
||||
mov r17, r16
|
||||
rcall ValueScheduler_GetValue
|
||||
clr r17
|
||||
tst r16
|
||||
breq ValueScheduler_SetValue_reduced
|
||||
inc r17
|
||||
ValueScheduler_SetValue_reduced:
|
||||
rcall ValueScheduler_GetValue ; R16=current value (none)
|
||||
cp r17, r16
|
||||
breq ValueScheduler_SetValue_end
|
||||
; value changed
|
||||
mov r16, r17
|
||||
tst r16
|
||||
tst r17
|
||||
breq ValueScheduler_SetValue_set0
|
||||
; set 1
|
||||
ldd r17, Y+VALSCHED_OFFS_FLAGS
|
||||
ori r17, (1<<VALSCHED_FLAGS_REPEAT_BIT) ; set repeat bit
|
||||
sbr r17, (1<<VALSCHED_FLAGS_REPEAT_BIT) ; set repeat bit
|
||||
sbrs r17, VALSCHED_FLAGS_REPEAT1_BIT
|
||||
andi r17, ~(1<<VALSCHED_FLAGS_REPEAT_BIT) ; clear repeat bit if not wanted for "1"
|
||||
ori r17, (1<<VALSCHED_FLAGS_VALUE_BIT) ; 1: set value bit and repeat bit
|
||||
cbr r17, (1<<VALSCHED_FLAGS_REPEAT_BIT) ; clear repeat bit if not wanted for "1"
|
||||
sbr r17, (1<<VALSCHED_FLAGS_VALUE_BIT) ; 1: set value bit
|
||||
std Y+VALSCHED_OFFS_FLAGS, r17 ; store new byte
|
||||
rjmp ValueScheduler_SetValue_resetTimer
|
||||
ValueScheduler_SetValue_set0:
|
||||
ldd r17, Y+VALSCHED_OFFS_FLAGS
|
||||
ori r17, (1<<VALSCHED_FLAGS_REPEAT_BIT)
|
||||
sbr r17, (1<<VALSCHED_FLAGS_REPEAT_BIT)
|
||||
sbrs r17, VALSCHED_FLAGS_REPEAT0_BIT
|
||||
andi r17, ~(1<<VALSCHED_FLAGS_REPEAT_BIT) ; clear repeat bit if not wanted for "0"
|
||||
andi r17, ~(1<<VALSCHED_FLAGS_VALUE_BIT) ; 0: clear value bit and repeat bit
|
||||
cbr r17, (1<<VALSCHED_FLAGS_REPEAT_BIT) ; clear repeat bit if not wanted for "0"
|
||||
cbr r17, (1<<VALSCHED_FLAGS_VALUE_BIT) ; 0: clear value bit
|
||||
std Y+VALSCHED_OFFS_FLAGS, r17 ; store new byte
|
||||
ValueScheduler_SetValue_resetTimer:
|
||||
clr r17 ; reset timer
|
||||
std Y+VALSCHED_OFFS_TIMER, r17
|
||||
; ldd r16, Y+VALSCHED_OFFS_FLAGS ; reset TOSEND flag
|
||||
; cbr r16, (1<<VALSCHED_FLAGS_TOSEND_BIT)
|
||||
; std Y+VALSCHED_OFFS_FLAGS, r16
|
||||
ValueScheduler_SetValue_end:
|
||||
ret
|
||||
; @end
|
||||
@@ -190,8 +195,7 @@ ValueScheduler_SetValue_end:
|
||||
|
||||
ValueScheduler_GetValue:
|
||||
ldd r16, Y+VALSCHED_OFFS_FLAGS
|
||||
lsr r16, VALSCHED_FLAGS_VALUE_BIT
|
||||
andi r16, 1
|
||||
andi r16, 1 ; CAVE: assumes data bit is bit0!!
|
||||
ret
|
||||
; @end
|
||||
|
||||
|
||||
Reference in New Issue
Block a user