avr: added memstat message.
This commit is contained in:
@@ -227,6 +227,7 @@
|
|||||||
.include "comproto_addr.asm"
|
.include "comproto_addr.asm"
|
||||||
.include "comproto_stats.asm"
|
.include "comproto_stats.asm"
|
||||||
.include "comproto_device.asm"
|
.include "comproto_device.asm"
|
||||||
|
.include "comproto_memstats.asm"
|
||||||
.include "comproto_values.asm"
|
.include "comproto_values.asm"
|
||||||
;.include "comproto_debug.asm"
|
;.include "comproto_debug.asm"
|
||||||
;.include "comproto_twi.asm"
|
;.include "comproto_twi.asm"
|
||||||
|
|||||||
@@ -36,6 +36,7 @@
|
|||||||
.equ CPRO_CMD_FLASH_RSP = 74
|
.equ CPRO_CMD_FLASH_RSP = 74
|
||||||
|
|
||||||
.equ CPRO_CMD_DEVICE = 80
|
.equ CPRO_CMD_DEVICE = 80
|
||||||
|
.equ CPRO_CMD_MEMSTATS = 81
|
||||||
|
|
||||||
|
|
||||||
; flags for variable payload enqueue function
|
; flags for variable payload enqueue function
|
||||||
|
|||||||
70
avr/comproto_memstats.asm
Normal file
70
avr/comproto_memstats.asm
Normal file
@@ -0,0 +1,70 @@
|
|||||||
|
; ***************************************************************************
|
||||||
|
; 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
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; Enqueue a MEMSTATS packet.
|
||||||
|
;
|
||||||
|
; IN:
|
||||||
|
; - R16: destination address
|
||||||
|
; OUT:
|
||||||
|
; - CFLAG: set if okay, clear otherwise
|
||||||
|
; MODIFIED REGS: R6, R16, R17, R18, R20 (R3, R4, R15, R19, R21, X)
|
||||||
|
|
||||||
|
CPRO_EnqueueMemStats:
|
||||||
|
mov r6, r16
|
||||||
|
|
||||||
|
rcall COM_AllocBufferAndGetXY ; (r16, r17, r21)
|
||||||
|
brcc CPRO_EnqueueMemStats_error
|
||||||
|
|
||||||
|
push xh
|
||||||
|
push xl
|
||||||
|
mov r16, r6
|
||||||
|
ldi r17, CPRO_PAYLOAD_FLAGS_UID | CPRO_PAYLOAD_FLAGS_SECONDS | (7<<CPRO_PAYLOAD_FLAGS_SHIFT_NUM)
|
||||||
|
ldi r18, CPRO_CMD_MEMSTATS
|
||||||
|
rcall cproBeginMsgWithVariablePayload ; (R3, R4, R16, R17, R18, R19, R20, R21, X)
|
||||||
|
; payload
|
||||||
|
in r17, SPL
|
||||||
|
st X+, r17 ; current stackpointer
|
||||||
|
in r17, SPH
|
||||||
|
st X+, r17
|
||||||
|
lds r17, comRecvBuffersUsed
|
||||||
|
st X+, r17 ; used buffers
|
||||||
|
lds r17, comStatsSendNoBuffer
|
||||||
|
st X+, r17 ; sendNoBuffer
|
||||||
|
lds r17, comStatsSendNoBuffer+1
|
||||||
|
st X+, r17
|
||||||
|
lds r17, comStatsRecvNoBuffer
|
||||||
|
st X+, r17 ; recvNoBuffer
|
||||||
|
lds r17, comStatsRecvNoBuffer+1
|
||||||
|
st X+, r17
|
||||||
|
pop xl
|
||||||
|
pop xh
|
||||||
|
rcall comCalcAndAddChecksumByte ; (R16, R17, R18, R19, X)
|
||||||
|
|
||||||
|
; mark buffer as enqueued with PRIO "normal" (slightly limited number of retries)
|
||||||
|
ldi r20, COM_BUFFER_PRIO_NORMAL
|
||||||
|
rcall COM_EnqueuePacket ; (R15, R16)
|
||||||
|
brcc CPRO_EnqueueMemStats_error
|
||||||
|
sec
|
||||||
|
ret
|
||||||
|
CPRO_EnqueueMemStats_error:
|
||||||
|
clc
|
||||||
|
ret
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
Reference in New Issue
Block a user