~ubuntu-branches/ubuntu/raring/avr-libc/raring-proposed

« back to all changes in this revision

Viewing changes to libc/pmstring/strnlen_PF.S

  • Committer: Bazaar Package Importer
  • Author(s): Hakan Ardo
  • Date: 2011-07-14 11:15:32 UTC
  • mfrom: (1.1.10 upstream) (4.1.6 sid)
  • Revision ID: james.westby@ubuntu.com-20110714111532-e83i3vqdowgxw8lv
Tags: 1:1.7.1-2
include/util/delay.h.in: Add math.h to list of includes (closes:
#633822)

Show diffs side-by-side

added added

removed removed

Lines of Context:
 
1
/* Copyright (c) 2006, Carlos Lamas
 
2
 
 
3
   based on libc/pmstring/strnlen_P.S which is
 
4
   Copyright (c) 2005, Helmut Wallner
 
5
 
 
6
   based on libc/pmstring/strnlen.S which is
 
7
   Copyright (c) 2002, Marek Michalkiewicz
 
8
 
 
9
   All rights reserved.
 
10
 
 
11
   Redistribution and use in source and binary forms, with or without
 
12
   modification, are permitted provided that the following conditions are met:
 
13
 
 
14
   * Redistributions of source code must retain the above copyright
 
15
     notice, this list of conditions and the following disclaimer.
 
16
   * Redistributions in binary form must reproduce the above copyright
 
17
     notice, this list of conditions and the following disclaimer in
 
18
     the documentation and/or other materials provided with the
 
19
     distribution.
 
20
   * Neither the name of the copyright holders nor the names of
 
21
     contributors may be used to endorse or promote products derived
 
22
     from this software without specific prior written permission.
 
23
 
 
24
  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 
25
  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 
26
  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 
27
  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
 
28
  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 
29
  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 
30
  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 
31
  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 
32
  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 
33
  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 
34
  POSSIBILITY OF SUCH DAMAGE. */
 
35
 
 
36
/* $Id: strnlen_PF.S 2191 2010-11-05 13:45:57Z arcanum $ */
 
37
 
 
38
 
 
39
#if !defined(__AVR_TINY__)
 
40
 
 
41
#include "macros.inc"
 
42
 
 
43
#define src_b3 r25
 
44
#define src_b2 r24
 
45
#define src_b1 r23
 
46
#define src_b0 r22
 
47
#define len_b1 r21
 
48
#define len_b0 r20
 
49
 
 
50
/** \ingroup avr_pgmspace
 
51
    \fn size_t strnlen_PF(uint_farptr_t s, size_t len)
 
52
    \brief Determine the length of a fixed-size string
 
53
 
 
54
    The strnlen_PF() function is similar to strnlen(), except that \e s is a
 
55
    far pointer to a string in program space
 
56
 
 
57
    \param s A far pointer to the string in Flash
 
58
    \param len The maximum number of length to return
 
59
 
 
60
    \returns The strnlen_PF function returns strlen_P(\e s), if that is less
 
61
    than \e len, or \e len if there is no '\\0' character among the first \e
 
62
    len characters pointed to by \e s. The contents of RAMPZ SFR are
 
63
    undefined when the function returns */
 
64
 
 
65
#if !defined(__DOXYGEN__)
 
66
 
 
67
        .text
 
68
        .global _U(strnlen_PF)
 
69
        .type   _U(strnlen_PF), @function
 
70
 
 
71
_U(strnlen_PF):
 
72
 
 
73
        LPM_R0_ZPLUS_INIT src_b2
 
74
        X_movw  ZL, src_b0
 
75
 
 
76
.L_strnlen_PF_loop:
 
77
 
 
78
        LPM_R0_ZPLUS_NEXT src_b2
 
79
        subi    len_b0, lo8(1)
 
80
        sbci    len_b1, hi8(1)
 
81
        cpse    r0, __zero_reg__
 
82
        brcc    .L_strnlen_PF_loop
 
83
 
 
84
; RAMPZ:Z points one character past the terminating NUL
 
85
; return RAMPZ:Z - 1 - src = (-1 - src) + RAMPZ:Z = ~src + RAMPZ:Z
 
86
 
 
87
        com     src_b0
 
88
        com     src_b1
 
89
        add     src_b0, ZL
 
90
        adc     src_b1, ZH
 
91
        X_movw  src_b2, src_b0          ; size_t is 16 bits
 
92
        ret
 
93
 
 
94
.L_strnlen_PF_end:
 
95
 
 
96
        .size   _U(strnlen_PF), .L_strnlen_PF_end - _U(strnlen_PF)
 
97
 
 
98
#endif /* not __DOXYGEN__ */
 
99
 
 
100
#endif /* !defined(__AVR_TINY__) */