a7d587a134
- send FLASH_READY - waits for FLASH_START NOTE: Utils_WaitNanoSecs only works reliably with values way above 1000 because 1000 is already one cycle time, and since each assembler command already uses multiple clock cycles a value of 1000 never flies.
482 lines
11 KiB
NASM
482 lines
11 KiB
NASM
; ***************************************************************************
|
|
; copyright : (C) 2023 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 FLASH_ERROR_NONE = 0
|
|
.equ FLASH_ERROR_BAD_MSGNUM = 1
|
|
.equ FLASH_ERROR_BAD_ADDR = 2
|
|
|
|
.equ FLASH_CMD_FLASH_RSP = 74
|
|
|
|
|
|
.equ FLASH_MSG_OFFS_DESTADDR = 0
|
|
.equ FLASH_MSG_OFFS_MSGLEN = 1
|
|
.equ FLASH_MSG_OFFS_MSGDATA = 2
|
|
.equ FLASH_MSG_OFFS_CMD = 2 ; first at COM2_MSG_OFFS_MSGDATA
|
|
.equ FLASH_MSG_OFFS_SRCADDR = 3
|
|
.equ FLASH_MSG_OFFS_PAYLOAD = 4 ; payload for the cmd follows here
|
|
|
|
|
|
.equ FLASH_PACKET_DATA_OFFS_ADDR = FLASH_MSG_OFFS_PAYLOAD+0 ; 2 bytes
|
|
.equ FLASH_PACKET_DATA_OFFS_DATA = FLASH_MSG_OFFS_PAYLOAD+2 ; n bytes
|
|
|
|
|
|
|
|
|
|
; ***************************************************************************
|
|
; data
|
|
|
|
|
|
.dseg
|
|
|
|
flashDataBegin:
|
|
flashUid: .byte 4
|
|
flashSendBuffer: .byte 64
|
|
flashRecvBuffer: .byte 64
|
|
flashDataEnd:
|
|
|
|
|
|
|
|
|
|
; ***************************************************************************
|
|
; code
|
|
|
|
|
|
.cseg
|
|
|
|
|
|
|
|
FLASH_PROTO_BEGIN:
|
|
|
|
|
|
|
|
|
|
bootLoader:
|
|
cli ; disable interrupts throughout the whole process
|
|
|
|
; setup stack
|
|
.ifdef SPH ; if SPH is defined
|
|
ldi r16, High(RAMEND)
|
|
out SPH, r16 ; init MSB stack pointer
|
|
.endif
|
|
ldi r16, Low(RAMEND)
|
|
out SPL, r16 ; init LSB stack pointer
|
|
|
|
; setup pins and interrupts
|
|
cbi COM_PORT_DATA, COM_PINNUM_DATA ; disable internal pullup for DATA
|
|
cbi COM_DDR_DATA, COM_PINNUM_DATA ; set DATA port as input
|
|
|
|
cbi COM_PORT_ATTN, COM_PINNUM_ATTN ; disable internal pullup for ATTN
|
|
cbi COM_DDR_ATTN, COM_PINNUM_ATTN ; set ATTN port as input
|
|
|
|
|
|
sbi DDRA, PORTA3 ; out
|
|
cbi PORTA, PORTA3 ; on
|
|
sbi DDRA, PORTA2 ; out (debug)
|
|
sbi PORTA, PORTA2 ; off (debug)
|
|
|
|
rcall flashReadUid
|
|
sts flashUid, r18
|
|
sts flashUid+1, r19
|
|
sts flashUid+2, r20
|
|
sts flashUid+3, r21
|
|
|
|
; wait for 3 secs before sending message
|
|
ldi r16, 30
|
|
rcall flashWaitForMulti100ms
|
|
|
|
; send flash ready message
|
|
ldi xl, LOW(flashSendBuffer)
|
|
ldi xh, HIGH(flashSendBuffer)
|
|
rcall flashWriteFlashReady
|
|
rcall flashSendPacketUntilSuccess
|
|
|
|
sbi PORTA, PORTA3 ; LED off
|
|
|
|
; wait up to 10s for incoming FLASH_START message
|
|
ldi r16, CPRO_CMD_FLASH_START
|
|
ldi r17, 100 ; 100*100ms=10s
|
|
rcall flashWaitForSpecificMessageWithLed
|
|
brcc bootLoader_startFirmware
|
|
|
|
; either FLASH_START or FLASH_END received
|
|
cpi r16, CPRO_CMD_FLASH_START ; not FLASH_START, no flashing requested
|
|
brne bootLoader_startFirmware
|
|
; receive and flash new firmware
|
|
|
|
; try to start firmware
|
|
bootLoader_startFirmware:
|
|
sbi PORTA, PORTA3 ; LED off
|
|
ldi r16, 20
|
|
rcall flashWaitForMulti100ms
|
|
|
|
ldi zl, LOW(firmwareStart*2)
|
|
ldi zh, HIGH(firmwareStart*2)
|
|
lpm r20, Z+
|
|
lpm r21, Z+
|
|
mov r16, r20
|
|
or r16, r21
|
|
breq bootLoader ; restart boot loader
|
|
|
|
; jmp via stack
|
|
push r20
|
|
push r21
|
|
ret
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; wait for a specific message to arrive within given time, flashing LED
|
|
;
|
|
; IN:
|
|
; - R16: message type to receive
|
|
; - R17: wait time in 100ms (1=100ms, 2=200ms etc.)
|
|
; OUT:
|
|
; - CFLAG: set if msg received (either expected msg or FLASH_END), cleared otherwise
|
|
; - R16: message type received (if CFLAG set)
|
|
; REGS: R2, R16, R17 (R1, R24, R25, X)
|
|
|
|
flashWaitForSpecificMessageWithLed:
|
|
mov r2, r16
|
|
sbi PORTA, PORTA3 ; LED off
|
|
|
|
flashWaitForSpecificMessageWithLed_loop:
|
|
sbi PINA, PORTA3 ; toggle LED
|
|
mov r16, r2
|
|
push r17
|
|
ldi r17, 100 ; wait up to 100ms
|
|
rcall flashWaitForSpecificMessage ; (R1, R16, R17, R24, R25, X)
|
|
pop r17
|
|
brcs flashWaitForSpecificMessageWithLed_received
|
|
dec r17
|
|
brne flashWaitForSpecificMessageWithLed_loop
|
|
sbi PORTA, PORTA3 ; off
|
|
clc
|
|
ret
|
|
flashWaitForSpecificMessageWithLed_received:
|
|
sbi PORTA, PORTA3 ; off
|
|
sec
|
|
ret
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; wait for a specific message to arrive within given time.
|
|
;
|
|
; IN:
|
|
; - R16: msg command to wait for
|
|
; - R17: time to wait for packet (in milliseconds)
|
|
; OUT:
|
|
; - CFLAG: set if msg received, cleared on timeout
|
|
; - R16 : message type received
|
|
; REGS: R1, R16, R17, X (R24, R25)
|
|
|
|
flashWaitForSpecificMessage:
|
|
mov r1, r16 ; expected message type
|
|
|
|
; wait for ATTN to go low
|
|
|
|
flashWaitForSpecificMessage_loop0:
|
|
flashWaitForSpecificMessage_loop1:
|
|
ldi r16, 0 ; wait for low
|
|
rcall flashWaitForAttnState1ms ; (R22, R24)
|
|
brcs flashWaitForSpecificMessage_isLow
|
|
dec r17
|
|
brne flashWaitForSpecificMessage_loop1
|
|
rjmp flashWaitForSpecificMessage_timeout
|
|
|
|
; receive message
|
|
flashWaitForSpecificMessage_isLow: ; is low, receive message, check for msg type
|
|
push r17
|
|
ldi r16, COM2_MAINTENANCE_ADDR
|
|
ldi xl, LOW(flashRecvBuffer)
|
|
ldi xh, HIGH(flashRecvBuffer)
|
|
rcall com2ReceivePacketRaw
|
|
pop r17
|
|
brcc flashWaitForSpecificMessage_waitAttnHigh
|
|
ldi xl, LOW(flashRecvBuffer)
|
|
ldi xh, HIGH(flashRecvBuffer)
|
|
adiw xh:xl, COM2_MSG_OFFS_CMD
|
|
ld r16, X
|
|
sbiw xh:xl, COM2_MSG_OFFS_CMD
|
|
cp r16, r1
|
|
breq flashWaitForSpecificMessage_received
|
|
cpi r16, CPRO_CMD_FLASH_END
|
|
breq flashWaitForSpecificMessage_received
|
|
|
|
flashWaitForSpecificMessage_waitAttnHigh:
|
|
dec r17
|
|
breq flashWaitForSpecificMessage_timeout
|
|
|
|
; wait for ATTN to go high
|
|
flashWaitForSpecificMessage_loop2:
|
|
ldi r16, 0xff ; wait for high
|
|
rcall flashWaitForAttnState1ms ; (R22, R24)
|
|
brcs flashWaitForSpecificMessage_isHigh
|
|
dec r17
|
|
brne flashWaitForSpecificMessage_loop2
|
|
rjmp flashWaitForSpecificMessage_timeout
|
|
|
|
flashWaitForSpecificMessage_isHigh:
|
|
rjmp flashWaitForSpecificMessage_loop0
|
|
|
|
flashWaitForSpecificMessage_received: ; R16 contains message type
|
|
sec
|
|
ret
|
|
flashWaitForSpecificMessage_timeout:
|
|
clc
|
|
ret
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; Wait for up to 1ms for ATTN line to reach the given state
|
|
;
|
|
; IN:
|
|
; - R16: expected state (0xff for high, 0 for low)
|
|
; OUT:
|
|
; - CFLAG: set if state reached, cleared otherwise
|
|
; REGS: R24 (R22)
|
|
|
|
flashWaitForAttnState1ms:
|
|
ldi r24, 100
|
|
flashWaitForAttnState1ms_loop:
|
|
push r17
|
|
in r17, COM_PIN_ATTN
|
|
eor r17, r16
|
|
andi r17, (1<<COM_PINNUM_ATTN)
|
|
pop r17
|
|
breq flashWaitForAttnState1ms_stateReached
|
|
|
|
Utils_WaitNanoSecs 10000, 0, r22 ; wait for 10us
|
|
dec r24
|
|
brne flashWaitForAttnState1ms_loop
|
|
clc
|
|
ret
|
|
flashWaitForAttnState1ms_stateReached:
|
|
sec
|
|
ret
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; wait indefinately until ATTN line is high, send packet over wire, retry until successfull
|
|
;
|
|
; IN:
|
|
; - x : ptr to buffer to send
|
|
; OUT:
|
|
; - nothing
|
|
; REGS: R15, R16, R22 (R17, R21, X)
|
|
|
|
flashSendPacketUntilSuccess:
|
|
push xl
|
|
push xh
|
|
rcall COM2_SendPacketWithAttn
|
|
pop xh
|
|
pop xl
|
|
brcc flashSendPacket_error
|
|
ret
|
|
flashSendPacket_error:
|
|
rcall flashWaitForAttnHigh
|
|
rjmp flashSendPacketUntilSuccess
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; wait indefinately for free ATTN line
|
|
;
|
|
; IN:
|
|
; - nothing
|
|
; OUT:
|
|
; - nothing
|
|
; REGS: R15, R16, R22 (R17, R21, X)
|
|
|
|
flashWaitForAttnHigh:
|
|
rcall com2WaitForAttnHigh ; waits for up to 100us
|
|
brcc flashWaitForAttnHigh_stillLow
|
|
ret
|
|
flashWaitForAttnHigh_stillLow:
|
|
rcall flashWaitDependingOnUid ; (R16, R18, R22, R24, R25)
|
|
rjmp flashWaitForAttnHigh
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; wait depending on lowest byte of uid.
|
|
;
|
|
; Wait interval is between 100ms and 25s (i.e. 255*100ms). This is used to avoid
|
|
; all nodes on the network trying to send messages at the exact same time (e.g. after
|
|
; power outage which would affect all nodes at the same time).
|
|
;
|
|
; IN:
|
|
; - nothing
|
|
; OUT:
|
|
; - nothing
|
|
; REGS: R16 (R18, R22, R24, R25)
|
|
|
|
flashWaitDependingOnUid:
|
|
lds r16, flashUid
|
|
tst r16
|
|
brne flashWaitDependingOnUid_l1
|
|
ldi r16, 17
|
|
flashWaitDependingOnUid_l1:
|
|
rjmp flashWaitForMulti100ms
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; wait for multiples of 100ms.
|
|
;
|
|
; IN:
|
|
; - R16: number of 100ms loops
|
|
; OUT:
|
|
; - nothing
|
|
; REGS: R16 (R18, R22, R24, R25)
|
|
|
|
flashWaitForMulti100ms:
|
|
flashWaitForMulti100ms_loop:
|
|
rcall flashWaitFor100ms ; (R18, R22, R24, R25)
|
|
dec r16
|
|
brne flashWaitForMulti100ms_loop
|
|
ret
|
|
|
|
|
|
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; wait for 100 milliseconds.
|
|
;
|
|
; IN:
|
|
; - nothing
|
|
; OUT:
|
|
; - nothing
|
|
; REGS: R18 (R22, R24, R25)
|
|
|
|
flashWaitFor100ms:
|
|
ldi r18, 100
|
|
flashWaitFor100ms_loop:
|
|
rcall flashWaitFor1ms ; (R22, R24, R25)
|
|
dec r18
|
|
brne flashWaitFor100ms_loop
|
|
ret
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; wait for 1 millisecond.
|
|
;
|
|
; IN:
|
|
; - nothing
|
|
; OUT:
|
|
; - nothing
|
|
; REGS: R24 (R22)
|
|
|
|
flashWaitFor1ms:
|
|
ldi r24, 10
|
|
flashWaitFor1ms_loop:
|
|
Utils_WaitNanoSecs 100000, 0, r22 ; wait for 100us
|
|
dec r24
|
|
brne flashWaitFor1ms_loop
|
|
ret
|
|
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; Write a FLASH_RESPONSE packet.
|
|
;
|
|
; IN:
|
|
; - R16: response code (0 if ok, error code otherwise)
|
|
; - X : buffer to write to
|
|
; OUT:
|
|
; - nothing
|
|
; MODIFIED REGS: R16, R17 (R18, R19, R20)
|
|
|
|
flashWriteFlashRsp:
|
|
clr r18
|
|
st X+, r18 ; dest address (unused)
|
|
ldi r18, 3 ; msg code+src address+one payload byte
|
|
st X+, r18 ; msg len
|
|
ldi r17, CPRO_CMD_FLASH_RSP
|
|
st X+, r17 ; msg code
|
|
clr r17
|
|
st X+, r17 ; src address (not used)
|
|
st X, r16 ; payload byte
|
|
sbiw xh:xl, 4
|
|
rcall com2CalcAndAddChecksumByte ; (R16, R17, R18, R19, R20, X)
|
|
sbiw xh:xl, 5
|
|
ret
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; Write a FLASH_READY packet.
|
|
;
|
|
; IN:
|
|
; - X : buffer to write to
|
|
; OUT:
|
|
; - nothing
|
|
; MODIFIED REGS: R16, Z (R17, R18, R19, R20)
|
|
|
|
flashWriteFlashReady:
|
|
clr r16
|
|
st X+, r16 ; dest address (unused)
|
|
ldi r16, 12 ; msg code+src address+ten payload bytes
|
|
st X+, r16 ; msg len
|
|
ldi r16, CPRO_CMD_FLASH_READY
|
|
st X+, r16 ; msg code
|
|
clr r16
|
|
st X+, r16 ; src address (not used)
|
|
; payload
|
|
lds r16, flashUid
|
|
st X+, r16
|
|
lds r16, flashUid+1
|
|
st X+, r16
|
|
lds r16, flashUid+2
|
|
st X+, r16
|
|
lds r16, flashUid+3
|
|
st X+, r16
|
|
ldi zl, low(firmwareType*2)
|
|
ldi zh, HIGH(firmwareType*2)
|
|
lpm r16, Z+
|
|
st X+, r16 ; firmwareType (low)
|
|
lpm r16, Z+
|
|
st X+, r16 ; firmwareType (high)
|
|
lpm r16, Z+
|
|
st X+, r16 ; firmwareVersion (low)
|
|
lpm r16, Z+
|
|
st X+, r16 ; firmwareVersion (high)
|
|
ldi r16, LOW(PAGESIZE*2)
|
|
st X+, r16
|
|
ldi r16, HIGH(PAGESIZE*2)
|
|
st X, r16
|
|
sbiw xh:xl, 13
|
|
rcall com2CalcAndAddChecksumByte ; (R16, R17, R18, R19, R20, X)
|
|
sbiw xh:xl, 14
|
|
ret
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
FLASH_PROTO_END:
|
|
.equ MODULE_SIZE_FLASH_PROTO = FLASH_PROTO_END-FLASH_PROTO_BEGIN
|
|
|
|
|