| 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 src_hi r25 |
#define src_hi r25 |
| 54 |
.global _U(strnlen) |
.global _U(strnlen) |
| 55 |
.type _U(strnlen), @function |
.type _U(strnlen), @function |
| 56 |
_U(strnlen): |
_U(strnlen): |
| 57 |
LOAD_Z(src_lo, src_hi) |
X_movw ZL, src_lo |
| 58 |
.strnlen_loop: |
.L_strnlen_loop: |
| 59 |
subi len_lo, lo8(1) |
subi len_lo, lo8(1) |
| 60 |
sbci len_hi, hi8(1) |
sbci len_hi, hi8(1) |
| 61 |
ld __tmp_reg__, Z+ |
ld __tmp_reg__, Z+ |
| 62 |
cpse __tmp_reg__, __zero_reg__ |
cpse __tmp_reg__, __zero_reg__ |
| 63 |
brcc .strnlen_loop |
brcc .L_strnlen_loop |
| 64 |
; Z points one character past the terminating NUL |
; Z points one character past the terminating NUL |
| 65 |
; return Z - 1 - src = (-1 - src) + Z = ~src + Z |
; return Z - 1 - src = (-1 - src) + Z = ~src + Z |
| 66 |
com src_lo |
com src_lo |
| 68 |
add src_lo, ZL |
add src_lo, ZL |
| 69 |
adc src_hi, ZH |
adc src_hi, ZH |
| 70 |
ret |
ret |
| 71 |
.strnlen_end: |
.L_strnlen_end: |
| 72 |
.size _U(strnlen), .strnlen_end - _U(strnlen) |
.size _U(strnlen), .L_strnlen_end - _U(strnlen) |
| 73 |
|
|
| 74 |
#endif /* not __DOXYGEN__ */ |
#endif /* not __DOXYGEN__ */ |