avr: add macros for ringbuffers using Y reg.
This commit is contained in:
@@ -4,6 +4,7 @@
|
|||||||
|
|
||||||
<extradist>
|
<extradist>
|
||||||
crc8.asm
|
crc8.asm
|
||||||
|
m_ringbuffer.asm
|
||||||
ringbuffer.asm
|
ringbuffer.asm
|
||||||
shared.asm
|
shared.asm
|
||||||
utils.asm
|
utils.asm
|
||||||
|
|||||||
114
avr/common/m_ringbuffer.asm
Normal file
114
avr/common/m_ringbuffer.asm
Normal file
@@ -0,0 +1,114 @@
|
|||||||
|
; ***************************************************************************
|
||||||
|
; copyright : (C) 2025 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. *
|
||||||
|
; ***************************************************************************
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @macro m_ringbuffer_y_writebyte
|
||||||
|
;
|
||||||
|
; @param R16 byte to write
|
||||||
|
; @param Y base address (for "LDD Y+nn" and "STD Y+nn")
|
||||||
|
; @param %0 constant maxBytes
|
||||||
|
; @param %1 offset to Y to access usedBytes variable (for "LDD Y+nn" and "STD Y+nn")
|
||||||
|
; @param %2 offset to Y to access readPos variable
|
||||||
|
; @param %3 offset to Y to access writePos variable
|
||||||
|
; @param %4 offset to Y to access buffer
|
||||||
|
; @return CFLAG set if okay, cleared on error (i.e. buffer full)
|
||||||
|
; @clobbers R17, X
|
||||||
|
|
||||||
|
.macro m_ringbuffer_y_writebyte
|
||||||
|
ldd r17, Y+@1 ; usedBytes
|
||||||
|
cpi r17, @0 ; maxBytes
|
||||||
|
brcc l_end
|
||||||
|
inc r17
|
||||||
|
std Y+@1, r17 ; usedBytes
|
||||||
|
ldd r17, Y+@3 ; writePos
|
||||||
|
mov xl, yl
|
||||||
|
mov xh, yh
|
||||||
|
adiw xh:xl, @4
|
||||||
|
add xl, r17
|
||||||
|
adc xh, r17
|
||||||
|
sub xh, r17
|
||||||
|
st X, r16
|
||||||
|
inc r17
|
||||||
|
cpi r17, @0
|
||||||
|
brcs l_store
|
||||||
|
clr r17
|
||||||
|
l_store:
|
||||||
|
std Y+@3, r17 ; writePos
|
||||||
|
sec
|
||||||
|
l_end:
|
||||||
|
.endmacro
|
||||||
|
; @end
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @macro m_ringbuffer_y_readbyte
|
||||||
|
;
|
||||||
|
; @param Y base address (for "LDD Y+nn" and "STD Y+nn")
|
||||||
|
; @param %0 constant maxBytes
|
||||||
|
; @param %1 offset to Y to access usedBytes variable (for "LDD Y+nn" and "STD Y+nn")
|
||||||
|
; @param %2 offset to Y to access readPos variable
|
||||||
|
; @param %3 offset to Y to access writePos variable
|
||||||
|
; @param %4 offset to Y to access buffer
|
||||||
|
; @return CFLAG set if okay, cleared on error (i.e. buffer full)
|
||||||
|
; @return R16 byte read
|
||||||
|
; @clobbers R17, X
|
||||||
|
|
||||||
|
.macro m_ringbuffer_y_readbyte
|
||||||
|
ldd r17, Y+@1 ; usedBytes
|
||||||
|
tst r17
|
||||||
|
clc
|
||||||
|
breq l_end
|
||||||
|
dec r17
|
||||||
|
std Y+@1, r17 ; usedBytes
|
||||||
|
ldd r17, Y+@2 ; readPos
|
||||||
|
mov xl, yl
|
||||||
|
mov xh, yh
|
||||||
|
adiw xh:xl, @4
|
||||||
|
add xl, r17
|
||||||
|
adc xh, r17
|
||||||
|
sub xh, r17
|
||||||
|
ld r16, X
|
||||||
|
inc r17
|
||||||
|
cpi r17, @0
|
||||||
|
brcs l_store
|
||||||
|
clr r17
|
||||||
|
l_store:
|
||||||
|
std Y+@2, r17 ; readPos
|
||||||
|
sec
|
||||||
|
l_end:
|
||||||
|
.endmacro
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
; ---------------------------------------------------------------------------
|
||||||
|
; @macro m_ringbuffer_y_reset
|
||||||
|
;
|
||||||
|
; @param Y base address (for "LDD Y+nn" and "STD Y+nn")
|
||||||
|
; @param %0 constant maxBytes
|
||||||
|
; @param %1 offset to Y to access usedBytes variable (for "LDD Y+nn" and "STD Y+nn")
|
||||||
|
; @param %2 offset to Y to access readPos variable
|
||||||
|
; @param %3 offset to Y to access writePos variable
|
||||||
|
; @param %4 offset to Y to access buffer
|
||||||
|
; @clobbers R17
|
||||||
|
|
||||||
|
.macro m_ringbuffer_y_reset
|
||||||
|
clr r17
|
||||||
|
std Y+@1, r17 ; usedBytes
|
||||||
|
std Y+@2, r17 ; readPos
|
||||||
|
std Y+@3, r17 ; writePos
|
||||||
|
l_end:
|
||||||
|
.endmacro
|
||||||
|
; @end
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
Reference in New Issue
Block a user