avr: added motion_activated_light module.
This commit is contained in:
Martin Preuss
11
avr/modules/ma_light/0BUILD
Normal file
11
avr/modules/ma_light/0BUILD
Normal file
@@ -0,0 +1,11 @@
|
|||||||
|
<?xml?>
|
||||||
|
|
||||||
|
<gwbuild>
|
||||||
|
|
||||||
|
<extradist>
|
||||||
|
main.asm
|
||||||
|
</extradist>
|
||||||
|
|
||||||
|
</gwbuild>
|
||||||
|
|
||||||
|
|
||||||
258
avr/modules/ma_light/main.asm
Normal file
258
avr/modules/ma_light/main.asm
Normal file
@@ -0,0 +1,258 @@
|
|||||||
|
; ***************************************************************************
|
||||||
|
; copyright : (C) 2024 by Martin Preuss
|
||||||
|
; email : martin@libchipcard.de
|
||||||
|
;
|
||||||
|
; ***************************************************************************
|
||||||
|
; * This file is part of the project "AqHome". *
|
||||||
|
; * Please see toplevel file COPYING of that project for license details. *
|
||||||
|
; ***************************************************************************
|
||||||
|
|
||||||
|
|
||||||
|
;.equ MOTIONLIGHT_DEFAULT_ONTIME = 3000
|
||||||
|
.equ MOTIONLIGHT_DEFAULT_ONTIME = 300
|
||||||
|
|
||||||
|
.equ MOTIONLIGHT_SOURCE_NUM = 2
|
||||||
|
|
||||||
|
.equ MOTIONLIGHT_SOURCE_OFFS_ADDR = 0
|
||||||
|
.equ MOTIONLIGHT_SOURCE_OFFS_VALUEID = 1
|
||||||
|
.equ MOTIONLIGHT_SOURCE_SIZE = 2
|
||||||
|
|
||||||
|
|
||||||
|
.dseg
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
motionLightDataBegin:
|
||||||
|
motionLightTimer: .byte 2
|
||||||
|
motionLightOnTime: .byte 2
|
||||||
|
motionLightColor: .byte 4
|
||||||
|
motionLightSources: .byte MOTIONLIGHT_SOURCE_NUM*MOTIONLIGHT_SOURCE_SIZE
|
||||||
|
motionLightDataEnd:
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
.cseg
|
||||||
|
|
||||||
|
MOTIONLIGHT_BEGIN:
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @routine MotionLight_Init @global
|
||||||
|
;
|
||||||
|
|
||||||
|
MotionLight_Init:
|
||||||
|
; preset SRAM data area
|
||||||
|
ldi xh, HIGH(motionLightDataBegin)
|
||||||
|
ldi xl, LOW(motionLightDataBegin)
|
||||||
|
clr r16
|
||||||
|
ldi r17, (motionLightDataEnd-motionLightDataBegin)
|
||||||
|
rcall Utils_FillSram
|
||||||
|
|
||||||
|
ldi xh, HIGH(motionLightColor)
|
||||||
|
ldi xl, LOW(motionLightColor)
|
||||||
|
clr r16
|
||||||
|
ldi r17, 0x80
|
||||||
|
st X+, r16 ; R
|
||||||
|
st X+, r16 ; G
|
||||||
|
st X+, r17 ; B
|
||||||
|
st X+, r16 ; WW
|
||||||
|
ldi r16, LOW(MOTIONLIGHT_DEFAULT_ONTIME)
|
||||||
|
sts motionLightOnTime, r16
|
||||||
|
ldi r16, HIGH(MOTIONLIGHT_DEFAULT_ONTIME)
|
||||||
|
sts motionLightOnTime+1, r16
|
||||||
|
|
||||||
|
; debug
|
||||||
|
ldi r16, 0x01
|
||||||
|
sts motionLightSources+MOTIONLIGHT_SOURCE_OFFS_ADDR, r16
|
||||||
|
ldi r16, 0x07
|
||||||
|
sts motionLightSources+MOTIONLIGHT_SOURCE_OFFS_VALUEID, r16
|
||||||
|
|
||||||
|
ret
|
||||||
|
; @end
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @routine MotionLight_Fini @global
|
||||||
|
;
|
||||||
|
|
||||||
|
MotionLight_Fini:
|
||||||
|
clr r16
|
||||||
|
sts motionLightTimer, r16 ; clear timer
|
||||||
|
sts motionLightTimer+1, r16
|
||||||
|
rjmp motionLightTurnOff
|
||||||
|
; @end
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @routine MotionLight_Every100ms @global
|
||||||
|
;
|
||||||
|
; @clobbers r16, r24, r26, (r17, r18, r19, r20, r21, r23)
|
||||||
|
|
||||||
|
MotionLight_Every100ms:
|
||||||
|
lds r24, motionLightTimer
|
||||||
|
lds r25, motionLightTimer+1
|
||||||
|
mov r16, r24
|
||||||
|
or r16, r25
|
||||||
|
brne MotionLight_Every100ms_dec
|
||||||
|
ret
|
||||||
|
MotionLight_Every100ms_dec:
|
||||||
|
sbiw r25:r24, 1
|
||||||
|
sts motionLightTimer, r24
|
||||||
|
sts motionLightTimer+1, r25
|
||||||
|
breq MotionLight_Every100ms_off
|
||||||
|
ret
|
||||||
|
MotionLight_Every100ms_off:
|
||||||
|
rjmp motionLightTurnOff ; (r16, r17, r18, r19, r20, r21, r23)
|
||||||
|
; @end
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @routine MotionLight_OnPacketReceived @global
|
||||||
|
;
|
||||||
|
; @clobbers any, -X
|
||||||
|
|
||||||
|
MotionLight_OnPacketReceived:
|
||||||
|
adiw xh:xl, 2 ; command
|
||||||
|
ld r16, X
|
||||||
|
sbiw xh:xl, 2
|
||||||
|
cpi r16, CPRO_CMD_VALUE_REPORT
|
||||||
|
breq MotionLight_OnPacketReceived_report
|
||||||
|
cpi r16, CPRO_CMD_VALUE_SET
|
||||||
|
breq MotionLight_OnPacketReceived_set
|
||||||
|
clc ; unexpected msg
|
||||||
|
ret
|
||||||
|
MotionLight_OnPacketReceived_report:
|
||||||
|
rcall CPRO_ReadValue ; (none)
|
||||||
|
rcall motionLightHasSource ; (r16, r24, Y)
|
||||||
|
brcs MotionLight_OnPacketReceived_turnOn
|
||||||
|
ret
|
||||||
|
MotionLight_OnPacketReceived_turnOn:
|
||||||
|
lds r16, motionLightTimer
|
||||||
|
lds r17, motionLightTimer+1
|
||||||
|
or r16, r17
|
||||||
|
brne MotionLight_OnPacketReceived_startTimer
|
||||||
|
rcall motionLightTurnOn ; (r16, r17, r18, r19, r20, r21, r23)
|
||||||
|
MotionLight_OnPacketReceived_startTimer:
|
||||||
|
rcall motionLightStartTimer
|
||||||
|
ret
|
||||||
|
MotionLight_OnPacketReceived_set:
|
||||||
|
rcall CPRO_ReadValue ; (none)
|
||||||
|
cpi r17, VALUE_ID_MAL_RGBW_VALUE
|
||||||
|
breq MotionLight_OnPacketReceived_setRGBW
|
||||||
|
cpi r17, VALUE_ID_MAL_ONTIME
|
||||||
|
breq MotionLight_OnPacketReceived_setOnTime
|
||||||
|
cpi r17, VALUE_ID_MAL_SOURCE1
|
||||||
|
breq MotionLight_OnPacketReceived_setSource1
|
||||||
|
cpi r17, VALUE_ID_MAL_SOURCE2
|
||||||
|
breq MotionLight_OnPacketReceived_setSource2
|
||||||
|
clc ; unexpected message
|
||||||
|
ret
|
||||||
|
MotionLight_OnPacketReceived_setRGBW:
|
||||||
|
sts motionLightColor, r18
|
||||||
|
sts motionLightColor+1, r19
|
||||||
|
sts motionLightColor+2, r20
|
||||||
|
sts motionLightColor+3, r21
|
||||||
|
rjmp MotionLight_OnPacketReceived_sendAck
|
||||||
|
MotionLight_OnPacketReceived_setOnTime:
|
||||||
|
sts motionLightOnTime, r18
|
||||||
|
sts motionLightOnTime+1, r19
|
||||||
|
rjmp MotionLight_OnPacketReceived_sendAck
|
||||||
|
MotionLight_OnPacketReceived_setSource1:
|
||||||
|
sts motionLightSources, r18 ; peerAddr
|
||||||
|
sts motionLightSources+1, r19 ; valueId
|
||||||
|
rjmp MotionLight_OnPacketReceived_sendAck
|
||||||
|
MotionLight_OnPacketReceived_setSource2:
|
||||||
|
sts motionLightSources+MOTIONLIGHT_SOURCE_SIZE, r18 ; peerAddr
|
||||||
|
sts motionLightSources+MOTIONLIGHT_SOURCE_SIZE+1, r19 ; valueId
|
||||||
|
MotionLight_OnPacketReceived_sendAck:
|
||||||
|
ldi r16, CPRO_CMD_VALUE_SET_ACK
|
||||||
|
rcall CPRO_SendSetValueResponse
|
||||||
|
sec
|
||||||
|
ret
|
||||||
|
; @end
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @routine motionLightHasSource
|
||||||
|
;
|
||||||
|
; @return CFLAGS set if we have a matching source entry, cleared otherwise
|
||||||
|
; @param r17 value id
|
||||||
|
; @param r22 source address
|
||||||
|
; @clobbers r16, r24, Y
|
||||||
|
|
||||||
|
motionLightHasSource:
|
||||||
|
ldi yl, LOW(motionLightSources)
|
||||||
|
ldi yh, HIGH(motionLightSources)
|
||||||
|
ldi r24, MOTIONLIGHT_SOURCE_NUM
|
||||||
|
motionLightHasSource_loop:
|
||||||
|
ldd r16, Y+MOTIONLIGHT_SOURCE_OFFS_ADDR
|
||||||
|
cp r16, r22
|
||||||
|
brne motionLightHasSource_next
|
||||||
|
ldd r16, Y+MOTIONLIGHT_SOURCE_OFFS_VALUEID
|
||||||
|
cp r16, r17
|
||||||
|
brne motionLightHasSource_next
|
||||||
|
sec
|
||||||
|
ret
|
||||||
|
motionLightHasSource_next:
|
||||||
|
adiw yh:yl, MOTIONLIGHT_SOURCE_SIZE
|
||||||
|
dec r24
|
||||||
|
brne motionLightHasSource_loop
|
||||||
|
clc
|
||||||
|
ret
|
||||||
|
; @end
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @routine motionLightStartTimer
|
||||||
|
;
|
||||||
|
; @clobbers r16
|
||||||
|
|
||||||
|
motionLightStartTimer:
|
||||||
|
lds r16, motionLightOnTime
|
||||||
|
sts motionLightTimer, r16
|
||||||
|
lds r16, motionLightOnTime+1
|
||||||
|
sts motionLightTimer+1, r16
|
||||||
|
ret
|
||||||
|
; @end
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @routine motionLightTurnOn
|
||||||
|
;
|
||||||
|
; @clobbers r18, r19, r20, r21 (r16, t17, r23)
|
||||||
|
|
||||||
|
motionLightTurnOn:
|
||||||
|
lds r18, motionLightColor
|
||||||
|
lds r19, motionLightColor+1
|
||||||
|
lds r20, motionLightColor+2
|
||||||
|
lds r21, motionLightColor+3
|
||||||
|
rjmp SK6812_SetAllColor ; (r16, r17, r23)
|
||||||
|
; @end
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @routine motionLightTurnOff
|
||||||
|
;
|
||||||
|
; @clobbers r18, r19, r20, r21 (r16, t17, r23)
|
||||||
|
|
||||||
|
motionLightTurnOff:
|
||||||
|
clr r18
|
||||||
|
clr r19
|
||||||
|
clr r20
|
||||||
|
clr r21
|
||||||
|
rjmp SK6812_SetAllColor ; (r16, r17, r23)
|
||||||
|
; @end
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
MOTIONLIGHT_END:
|
||||||
|
.equ MODULE_SIZE_MOTIONLIGHT = MOTIONLIGHT_END-MOTIONLIGHT_BEGIN
|
||||||
|
|
||||||
|
|
||||||
Reference in New Issue
Block a user