summaryrefslogtreecommitdiff
path: root/firmware/asm/strlen.c
blob: d5326584b5391269b77bfdc290651ee6d03fde41 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
/*
FUNCTION
        <<strlen>>---character string length
        
INDEX
        strlen

ANSI_SYNOPSIS
        #include <string.h>
        size_t strlen(const char *<[str]>);

TRAD_SYNOPSIS
        #include <string.h>
        size_t strlen(<[str]>)
        char *<[src]>;

DESCRIPTION
        The <<strlen>> function works out the length of the string
        starting at <<*<[str]>>> by counting chararacters until it
        reaches a <<NULL>> character.

RETURNS
        <<strlen>> returns the character count.

PORTABILITY
<<strlen>> is ANSI C.

<<strlen>> requires no supporting OS subroutines.

QUICKREF
        strlen ansi pure
*/

#include "config.h"
#include "_ansi.h"
#include <string.h>
#include <limits.h>

#define LBLOCKSIZE   (sizeof (long))
#define ROCKBOX_UNALIGNED(X) ((long)X & (LBLOCKSIZE - 1))

#if LONG_MAX == 2147483647L
#define DETECTNULL(X) (((X) - 0x01010101) & ~(X) & 0x80808080)
#else
#if LONG_MAX == 9223372036854775807L
/* Nonzero if X (a long int) contains a NULL byte. */
#define DETECTNULL(X) (((X) - 0x0101010101010101) & ~(X) & 0x8080808080808080)
#else
#error long int is not a 32bit or 64bit type.
#endif
#endif

#ifndef DETECTNULL
#error long int is not a 32bit or 64bit byte
#endif

size_t
_DEFUN (strlen, (str),
        _CONST char *str) ICODE_ATTR;

size_t
_DEFUN (strlen, (str),
        _CONST char *str)
{
#if defined(PREFER_SIZE_OVER_SPEED) || defined(__OPTIMIZE_SIZE__)
  _CONST char *start = str;

  while (*str)
    str++;

  return str - start;
#else
  _CONST char *start = str;
  unsigned long *aligned_addr;

  if (!ROCKBOX_UNALIGNED (str))
    {
      /* If the string is word-aligned, we can check for the presence of 
         a null in each word-sized block.  */
      aligned_addr = (unsigned long*)str;
      while (!DETECTNULL (*aligned_addr))
        aligned_addr++;

      /* Once a null is detected, we check each byte in that block for a
         precise position of the null.  */
      str = (char*)aligned_addr;
    }
 
  while (*str)
    str++;
  return str - start;
#endif /* not PREFER_SIZE_OVER_SPEED */
}