| 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 |
| 52 |
.global _U(memset) |
.global _U(memset) |
| 53 |
.type _U(memset), @function |
.type _U(memset), @function |
| 54 |
_U(memset): |
_U(memset): |
| 55 |
LOAD_X(dest_lo, dest_hi) |
X_movw XL, dest_lo |
| 56 |
#if OPTIMIZE_SPEED |
#if OPTIMIZE_SPEED |
| 57 |
; 11 words, (12 + len * 4 - (len & 1)) cycles |
; 11 words, (12 + len * 4 - (len & 1)) cycles |
| 58 |
sbrs len_lo, 0 |
sbrs len_lo, 0 |
| 59 |
rjmp .memset_start |
rjmp .L_memset_start |
| 60 |
rjmp .memset_odd |
rjmp .L_memset_odd |
| 61 |
.memset_loop: |
.L_memset_loop: |
| 62 |
st X+, val_lo |
st X+, val_lo |
| 63 |
.memset_odd: |
.L_memset_odd: |
| 64 |
st X+, val_lo |
st X+, val_lo |
| 65 |
.memset_start: |
.L_memset_start: |
| 66 |
subi len_lo, lo8(2) |
subi len_lo, lo8(2) |
| 67 |
sbci len_hi, hi8(2) |
sbci len_hi, hi8(2) |
| 68 |
#else |
#else |
| 69 |
; 8 words, (11 + len * 6) cycles |
; 8 words, (11 + len * 6) cycles |
| 70 |
rjmp .memset_start |
rjmp .L_memset_start |
| 71 |
.memset_loop: |
.L_memset_loop: |
| 72 |
st X+, val_lo |
st X+, val_lo |
| 73 |
.memset_start: |
.L_memset_start: |
| 74 |
subi len_lo, lo8(1) |
subi len_lo, lo8(1) |
| 75 |
sbci len_hi, hi8(1) |
sbci len_hi, hi8(1) |
| 76 |
#endif |
#endif |
| 77 |
brcc .memset_loop |
brcc .L_memset_loop |
| 78 |
; return dest (unchanged) |
; return dest (unchanged) |
| 79 |
ret |
ret |
| 80 |
.memset_end: |
.L_memset_end: |
| 81 |
.size _U(memset), .memset_end - _U(memset) |
.size _U(memset), .L_memset_end - _U(memset) |
| 82 |
|
|
| 83 |
#endif /* not DOXYGEN */ |
#endif /* not DOXYGEN */ |