26 |
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
27 |
POSSIBILITY OF SUCH DAMAGE. */ |
POSSIBILITY OF SUCH DAMAGE. */ |
28 |
|
|
29 |
|
/* $Id$ */ |
30 |
|
|
31 |
#include "macros.inc" |
#include "macros.inc" |
32 |
|
|
33 |
#define dest_hi r25 |
#define dest_hi r25 |
53 |
.global _U(memcpy) |
.global _U(memcpy) |
54 |
.type _U(memcpy), @function |
.type _U(memcpy), @function |
55 |
_U(memcpy): |
_U(memcpy): |
56 |
LOAD_Z(src_lo, src_hi) |
X_movw ZL, src_lo |
57 |
LOAD_X(dest_lo, dest_hi) |
X_movw XL, dest_lo |
58 |
#if OPTIMIZE_SPEED |
#if OPTIMIZE_SPEED |
59 |
; 15 words, (14 + len * 6 - (len & 1)) cycles |
; 15 words, (14 + len * 6 - (len & 1)) cycles |
60 |
sbrs len_lo, 0 |
sbrs len_lo, 0 |
61 |
rjmp .memcpy_start |
rjmp .L_memcpy_start |
62 |
rjmp .memcpy_odd |
rjmp .L_memcpy_odd |
63 |
.memcpy_loop: |
.L_memcpy_loop: |
64 |
ld __tmp_reg__, Z+ |
ld __tmp_reg__, Z+ |
65 |
st X+, __tmp_reg__ |
st X+, __tmp_reg__ |
66 |
.memcpy_odd: |
.L_memcpy_odd: |
67 |
ld __tmp_reg__, Z+ |
ld __tmp_reg__, Z+ |
68 |
st X+, __tmp_reg__ |
st X+, __tmp_reg__ |
69 |
.memcpy_start: |
.L_memcpy_start: |
70 |
subi len_lo, lo8(2) |
subi len_lo, lo8(2) |
71 |
sbci len_hi, hi8(2) |
sbci len_hi, hi8(2) |
72 |
#else |
#else |
73 |
; 11 words, (13 + len * 8) cycles |
; 11 words, (13 + len * 8) cycles |
74 |
rjmp .memcpy_start |
rjmp .L_memcpy_start |
75 |
.memcpy_loop: |
.L_memcpy_loop: |
76 |
ld __tmp_reg__, Z+ |
ld __tmp_reg__, Z+ |
77 |
st X+, __tmp_reg__ |
st X+, __tmp_reg__ |
78 |
.memcpy_start: |
.L_memcpy_start: |
79 |
subi len_lo, lo8(1) |
subi len_lo, lo8(1) |
80 |
sbci len_hi, hi8(1) |
sbci len_hi, hi8(1) |
81 |
#endif |
#endif |
82 |
brcc .memcpy_loop |
brcc .L_memcpy_loop |
83 |
; return dest (unchanged) |
; return dest (unchanged) |
84 |
ret |
ret |
85 |
.memcpy_end: |
.L_memcpy_end: |
86 |
.size _U(memcpy), .memcpy_end - _U(memcpy) |
.size _U(memcpy), .L_memcpy_end - _U(memcpy) |
87 |
|
|
88 |
#endif /* not __DOXYGEN__ */ |
#endif /* not __DOXYGEN__ */ |