avr: more work on avr app framework.

This commit is contained in:
Martin Preuss
2025-05-01 00:56:03 +02:00
parent 614a30fd4e
commit e56f2600e8
8 changed files with 253 additions and 13 deletions

View File

@@ -17,18 +17,18 @@
; ---------------------------------------------------------------------------
; @routine Main_SendValue
; @routine Main_SendValueReport
;
; @param R17 value id
; @param R19:R18 value
; @param R21:R20 denom (e.g. 100, meaning value must be divided by 100)
; @param R22 value type
Main_SendValue:
Main_SendValueReport:
push r17
rcall NET_Buffer_Alloc ; (R16, R17, X)
pop r17
brcc sendValue_end ; jmp on error
brcc Main_SendValueReport_end ; jmp on error
push r16 ; buffer num
ldi r16, 0xff ; DEST addr
adiw xh:xl, 1
@@ -38,10 +38,43 @@ Main_SendValue:
sbiw xh:xl, 1
pop r16 ; buffer num
rcall NET_Interface_AddOutgoingMsgNum ; (R17, R18, X)
brcs sendValue_end ; jump if okay
brcs Main_SendValueReport_end ; jump if okay
rcall NET_Buffer_ReleaseByNum ; otherwise release buffer
clc
sendValue_end:
Main_SendValueReport_end:
ret
; @end
; ---------------------------------------------------------------------------
; @routine Main_SendValueResponse
;
; @param R17 value id
; @param R19:R18 value
; @param R21:R20 denom (e.g. 100, meaning value must be divided by 100)
; @param R22 value type
; @param R23 command
; @param R25:R24 ref msg id
Main_SendValueResponse:
push r17
rcall NET_Buffer_Alloc ; (R16, R17, X)
pop r17
brcc Main_SendValueResponse_end ; jmp on error
push r16 ; buffer num
ldi r16, 0xff ; DEST addr
adiw xh:xl, 1
ldi yl, LOW(netInterfaceData)
ldi yh, HIGH(netInterfaceData)
rcall NETMSG_ValueWriteResponse ; (R16, R17, R18, R19, R20, R21, R23, R24, R25)
sbiw xh:xl, 1
pop r16 ; buffer num
rcall NET_Interface_AddOutgoingMsgNum ; (R17, R18, X)
brcs Main_SendValueResponse_end ; jump if okay
rcall NET_Buffer_ReleaseByNum ; otherwise release buffer
clc
Main_SendValueResponse_end:
ret
; @end
@@ -56,12 +89,12 @@ sendValue_end:
; @param R17 value id
; @param R22 value type
Main_Send8BitValue:
Main_Send8BitValueReport:
mov r18, r16 ; R19:R18 = value
clr r19
ldi r20, 1 ; R21:R20 = denom
clr r21
rjmp Main_SendValue
rjmp Main_SendValueReport
; @end