7a5900be25
Main code might work at 8 MHz, but boot code is compiled for 1 MHz, so we need to set speed accordingly when rebooting into boot loader.
73 lines
1.8 KiB
NASM
73 lines
1.8 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. *
|
|
; ***************************************************************************
|
|
|
|
|
|
|
|
|
|
; ***************************************************************************
|
|
; code
|
|
|
|
.cseg
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; Handle reboot request
|
|
;
|
|
; IN:
|
|
; - X : buffer containing the received packet
|
|
; OUT:
|
|
; - nothing
|
|
; REGS:
|
|
|
|
cproHandleReboot:
|
|
adiw xh:xl, CPRO_PACKET_REBOOTREQ_OFFS_UID
|
|
rcall cproCheckUidInMsg
|
|
brcc cproHandleReboot_notHandled
|
|
sbiw xh:xl, CPRO_PACKET_REBOOTREQ_OFFS_UID+4
|
|
adiw xh:xl, COM2_MSG_OFFS_SRCADDR
|
|
ld r16, x
|
|
cpi r16, 0xff
|
|
breq cproHandleReboot_notHandled ; dont handle src address 255
|
|
cproHandleReboot_loop1:
|
|
push r16
|
|
ldi xl, LOW(com2SendBuffer)
|
|
ldi xh, HIGH(com2SendBuffer)
|
|
rcall CPRO_WriteRebootResponse
|
|
rcall COM2_SendPacket
|
|
pop r16
|
|
brcc cproHandleReboot_loop1
|
|
|
|
; directly call bootloader
|
|
cli
|
|
rcall systemSetBootSpeed ; reset speed if necessary (TODO: let bootloader set its speed)
|
|
rjmp BOOTLOADER_ADDR
|
|
cproHandleReboot_notHandled:
|
|
clc
|
|
ret
|
|
|
|
|
|
|
|
; ---------------------------------------------------------------------------
|
|
; Write a Reboot Response packet.
|
|
;
|
|
; IN:
|
|
; - R16: destination address
|
|
; - X : buffer to write to
|
|
; OUT:
|
|
; - nothing
|
|
; REGS: R3, R4, R16, R17, R18, X (R19, R20, R21)
|
|
|
|
CPRO_WriteRebootResponse:
|
|
ldi r18, CPRO_CMD_REBOOT_RESPONSE
|
|
rjmp COM2_WriteMsgWithCmdAndSrcAddr ; R3, R4, R15, R16, R17, R18, R19, R20, R21, X
|
|
|
|
|
|
|