removed idle time calculation (doesn't work so far).
This commit is contained in:
@@ -34,7 +34,7 @@ CPRO_EnqueueMemStats:
|
||||
push xh
|
||||
push xl
|
||||
mov r16, r6
|
||||
ldi r17, CPRO_PAYLOAD_FLAGS_UID | CPRO_PAYLOAD_FLAGS_SECONDS | (9<<CPRO_PAYLOAD_FLAGS_SHIFT_NUM)
|
||||
ldi r17, CPRO_PAYLOAD_FLAGS_UID | CPRO_PAYLOAD_FLAGS_SECONDS | (8<<CPRO_PAYLOAD_FLAGS_SHIFT_NUM)
|
||||
ldi r18, CPRO_CMD_MEMSTATS
|
||||
rcall cproBeginMsgWithVariablePayload ; (R3, R4, R16, R17, R18, R19, R20, R21, X)
|
||||
; payload
|
||||
@@ -54,12 +54,6 @@ CPRO_EnqueueMemStats:
|
||||
st X+, r17 ; recvNoBuffer
|
||||
lds r17, comStatsRecvNoBuffer+1
|
||||
st X+, r17
|
||||
push xl
|
||||
push xh
|
||||
rcall Timer_CalcIdle ; (r16, r17, r18, r24, r25, X)
|
||||
pop xh
|
||||
pop xl
|
||||
st X+, r16
|
||||
pop xl
|
||||
pop xh
|
||||
rcall comCalcAndAddChecksumByte ; (R16, R17, R18, R19, X)
|
||||
|
||||
@@ -34,7 +34,7 @@ CPRO_EnqueueSysStats:
|
||||
push xh
|
||||
push xl
|
||||
mov r16, r6
|
||||
ldi r17, CPRO_PAYLOAD_FLAGS_UID | CPRO_PAYLOAD_FLAGS_SECONDS | (9<<CPRO_PAYLOAD_FLAGS_SHIFT_NUM)
|
||||
ldi r17, CPRO_PAYLOAD_FLAGS_UID | CPRO_PAYLOAD_FLAGS_SECONDS | (4<<CPRO_PAYLOAD_FLAGS_SHIFT_NUM)
|
||||
ldi r18, CPRO_CMD_SYSSTATS
|
||||
rcall cproBeginMsgWithVariablePayload ; (R3, R4, R16, R17, R18, R19, R20, R21, X)
|
||||
; payload
|
||||
@@ -47,13 +47,6 @@ CPRO_EnqueueSysStats:
|
||||
st X+, r17 ; timer interrupts
|
||||
lds r17, timerInterrupts+1
|
||||
st X+, r17
|
||||
|
||||
push xl
|
||||
push xh
|
||||
rcall Timer_CalcIdle ; (r16, r17, r18, r24, r25, X)
|
||||
pop xh
|
||||
pop xl
|
||||
st X+, r16 ; idle percentage
|
||||
pop xl
|
||||
pop xh
|
||||
rcall comCalcAndAddChecksumByte ; (R16, R17, R18, R19, X)
|
||||
|
||||
@@ -71,8 +71,6 @@ main_loop:
|
||||
; cbi PORTA, PORTA2 ; debug (on)
|
||||
; sbi PORTA, PORTA2 ; debug (off)
|
||||
|
||||
rcall Timer_BeforeSleep
|
||||
|
||||
; only modify SE, SM1 and SM0
|
||||
in r16, MCUCR
|
||||
ldi r17, (1<<SE) | (1<<SM1) | (1<<SM0)
|
||||
@@ -81,7 +79,6 @@ main_loop:
|
||||
ori r16, (1<<SE) ; sleep mode "idle", enable
|
||||
out MCUCR, r16
|
||||
sleep ; sleep, wait for interrupt
|
||||
rcall Timer_AfterSleep
|
||||
rjmp main_loop
|
||||
|
||||
|
||||
|
||||
@@ -16,7 +16,6 @@
|
||||
|
||||
.equ TIMER_FLAGS_IF_ADDR = 1
|
||||
|
||||
.equ TIMER_STATES_MASK = 7
|
||||
|
||||
|
||||
|
||||
@@ -30,9 +29,6 @@ timerModuleTickCounter: .byte 1
|
||||
timerTicksSinceLastRun: .byte 2
|
||||
timerModuleCounterSecs: .byte 4
|
||||
timerInterrupts: .byte 2
|
||||
timerStateBeforeSleep: .byte 1
|
||||
timerStatePos: .byte 1
|
||||
timerStates: .byte TIMER_STATES_MASK+1
|
||||
timerModuleData_end:
|
||||
|
||||
|
||||
@@ -248,68 +244,6 @@ timerCallR19R18:
|
||||
|
||||
|
||||
|
||||
Timer_AfterSleep:
|
||||
in r16, TCNT0
|
||||
sts timerStateBeforeSleep, r16
|
||||
ret
|
||||
|
||||
|
||||
|
||||
Timer_BeforeSleep:
|
||||
in r16, TCNT0 ; read counter value
|
||||
lds r17, timerStateBeforeSleep
|
||||
sub r16, r17
|
||||
brcc Timer_BeforeSleep_l1
|
||||
ldi r17, 98-1
|
||||
add r16, r17
|
||||
Timer_BeforeSleep_l1:
|
||||
ldi xl, LOW(timerStates)
|
||||
ldi xh, HIGH(timerStates)
|
||||
lds r18, timerStatePos
|
||||
clr r17
|
||||
add xl, r18
|
||||
adc xh, r17
|
||||
st X, r16
|
||||
inc r18
|
||||
andi r18, TIMER_STATES_MASK
|
||||
sts timerStatePos, r18
|
||||
ret
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; Calculate aproximate idle percentage
|
||||
;
|
||||
; IN:
|
||||
; OUT:
|
||||
; - R16: approximate idle percentage (between 0 and 97)
|
||||
; REGS: r16, r17, r18, r24, r25, X
|
||||
|
||||
Timer_CalcIdle:
|
||||
ldi xl, LOW(timerStates)
|
||||
ldi xh, HIGH(timerStates)
|
||||
ldi r18, TIMER_STATES_MASK+1
|
||||
clr r24
|
||||
clr r25
|
||||
clr r17
|
||||
Timer_CalcIdle_loop:
|
||||
ld r16, X+
|
||||
add r24, r16
|
||||
adc r25, r17
|
||||
dec r18
|
||||
brne Timer_CalcIdle_loop
|
||||
lsr r25
|
||||
ror r24
|
||||
lsr r25
|
||||
ror r24
|
||||
lsr r25
|
||||
ror r24
|
||||
mov r16, r24
|
||||
ret
|
||||
|
||||
|
||||
|
||||
|
||||
; ---------------------------------------------------------------------------
|
||||
; OC0A interrupt handler
|
||||
;
|
||||
|
||||
Reference in New Issue
Block a user