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