ldso/include/dl-string.h

   1 #ifndef _LINUX_STRING_H_
   2 #define _LINUX_STRING_H_
   3
   4 #include <dl-sysdep.h> // for do_rem
   5
   6 static size_t _dl_strlen(const char * str);
   7 static char *_dl_strcat(char *dst, const char *src);
   8 static char * _dl_strcpy(char * dst,const char *src);
   9 static int _dl_strcmp(const char * s1,const char * s2);
  10 static int _dl_strncmp(const char * s1,const char * s2,size_t len);
  11 static char * _dl_strchr(const char * str,int c);
  12 static char *_dl_strrchr(const char *str, int c);
  13 static char *_dl_strstr(const char *s1, const char *s2);
  14 static void * _dl_memcpy(void * dst, const void * src, size_t len);
  15 static int _dl_memcmp(const void * s1,const void * s2,size_t len);
  16 static void *_dl_memset(void * str,int c,size_t len);
  17 static char *_dl_get_last_path_component(char *path);
  18 static char *_dl_simple_ltoa(char * local, unsigned long i);
  19 static char *_dl_simple_ltoahex(char * local, unsigned long i);
  20
  21 #ifndef NULL
  22 #define NULL ((void *) 0)
  23 #endif
  24
  25 static __always_inline size_t _dl_strlen(const char * str)
  26 {
  27         register const char *ptr = (char *) str-1;
  28
  29         while (*++ptr);
  30         return (ptr - str);
  31 }
  32
  33 static __always_inline char * _dl_strcat(char *dst, const char *src)
  34 {
  35         register char *ptr = dst-1;
  36
  37         src--;
  38         while (*++ptr)
  39                 ;/* empty */
  40         ptr--;
  41         while ((*++ptr = *++src) != 0)
  42                 ;/* empty */
  43         return dst;
  44 }
  45
  46 static inline char * __attribute__((__always_inline__)) _dl_strcpy(char * dst,const char *src)
  47 {
  48         register char *ptr = dst;
  49
  50         dst--;src--;
  51         while ((*++dst = *++src) != 0);
  52
  53         return ptr;
  54 }
  55
  56 static inline int __attribute__((__always_inline__)) _dl_strcmp(const char * s1,const char * s2)
  57 {
  58         register unsigned char c1, c2;
  59         s1--;s2--;
  60         do {
  61                 c1 = (unsigned char) *++s1;
  62                 c2 = (unsigned char) *++s2;
  63                 if (c1 == '\0')
  64                         return c1 - c2;
  65         }
  66         while (c1 == c2);
  67
  68         return c1 - c2;
  69 }
  70
  71 static inline int __attribute__((__always_inline__)) _dl_strncmp(const char * s1,const char * s2,size_t len)
  72 {
  73         register unsigned char c1 = '\0';
  74         register unsigned char c2 = '\0';
  75
  76         s1--;s2--;
  77         while (len > 0) {
  78                 c1 = (unsigned char) *++s1;
  79                 c2 = (unsigned char) *++s2;
  80                 if (c1 == '\0' || c1 != c2)
  81                         return c1 - c2;
  82                 len--;
  83         }
  84         return c1 - c2;
  85 }
  86
  87 static inline char * __attribute__((__always_inline__)) _dl_strchr(const char * str,int c)
  88 {
  89         register char ch;
  90         str--;
  91         do {
  92                 if ((ch = *++str) == c)
  93                         return (char *) str;
  94         }
  95         while (ch);
  96
  97         return 0;
  98 }
  99
 100 static inline char * _dl_strrchr(const char *str, int c)
 101 {
 102     register char *prev = 0;
 103     register char *ptr = (char *) str-1;
 104
 105     while (*++ptr != '\0') {
 106         if (*ptr == c)
 107             prev = ptr;
 108     }
 109     if (c == '\0')
 110         return(ptr);
 111     return(prev);
 112 }
 113
 114 static inline char * _dl_strstr(const char *s1, const char *s2)
 115 {
 116     register const char *s = s1;
 117     register const char *p = s2;
 118
 119     do {
 120         if (!*p) {
 121             return (char *) s1;;
 122         }
 123         if (*p == *s) {
 124             ++p;
 125             ++s;
 126         } else {
 127             p = s2;
 128             if (!*s) {
 129               return NULL;
 130             }
 131             s = ++s1;
 132         }
 133     } while (1);
 134 }
 135
 136 static inline void * _dl_memcpy(void * dst, const void * src, size_t len)
 137 {
 138         register char *a = dst-1;
 139         register const char *b = src-1;
 140
 141         while (len) {
 142                 *++a = *++b;
 143                 --len;
 144         }
 145         return dst;
 146 }
 147
 148 static inline int __attribute__((__always_inline__)) _dl_memcmp(const void * s1,const void * s2,size_t len)
 149 {
 150         unsigned char *c1 = (unsigned char *)s1-1;
 151         unsigned char *c2 = (unsigned char *)s2-1;
 152
 153         while (len) {
 154                 if (*++c1 != *++c2)
 155                         return *c1 - *c2;
 156                 len--;
 157         }
 158         return 0;
 159 }
 160
 161 #if defined(powerpc)
 162 /* Will generate smaller and faster code due to loop unrolling.*/
 163 static inline void * __attribute__((__always_inline__)) _dl_memset(void *to, int c, size_t n)
 164 {
 165         unsigned long chunks;
 166         unsigned long *tmp_to;
 167         unsigned char *tmp_char;
 168
 169         chunks = n / 4;
 170         tmp_to = to + n;
 171         c = c << 8 | c;
 172         c = c << 16 | c;
 173         if (!chunks)
 174                 goto lessthan4;
 175         do {
 176                 *--tmp_to = c;
 177         } while (--chunks);
 178  lessthan4:
 179         n = n % 4;
 180         if (!n ) return to;
 181         tmp_char = (unsigned char *)tmp_to;
 182         do {
 183                 *--tmp_char = c;
 184         } while (--n);
 185         return to;
 186 }
 187 #else
 188 static inline void * __attribute__((__always_inline__)) _dl_memset(void * str,int c,size_t len)
 189 {
 190         register char *a = str;
 191
 192         while (len--)
 193                 *a++ = c;
 194
 195         return str;
 196 }
 197 #endif
 198
 199 static inline char * __attribute__((__always_inline__)) _dl_get_last_path_component(char *path)
 200 {
 201         register char *ptr = path-1;
 202
 203         while (*++ptr)
 204                 ;/* empty */
 205
 206         /* strip trailing slashes */
 207         while (ptr != path && *--ptr == '/') {
 208                 *ptr = '\0';
 209         }
 210
 211         /* find last component */
 212         while (ptr != path && *--ptr != '/')
 213                 ;/* empty */
 214         return ptr == path ? ptr : ptr+1;
 215 }
 216
 217 /* Early on, we can't call printf, so use this to print out
 218  * numbers using the SEND_STDERR() macro.  Avoid using mod
 219  * or using long division */
 220 static inline char * __attribute__((__always_inline__)) _dl_simple_ltoa(char * local, unsigned long i)
 221 {
 222         /* 20 digits plus a null terminator should be good for
 223          * 64-bit or smaller ints (2^64 - 1)*/
 224         char *p = &local[22];
 225         *--p = '\0';
 226         do {
 227             char temp;
 228             do_rem(temp, i, 10);
 229             *--p = '0' + temp;
 230             i /= 10;
 231         } while (i > 0);
 232         return p;
 233 }
 234
 235 static inline char * __attribute__((__always_inline__)) _dl_simple_ltoahex(char * local, unsigned long i)
 236 {
 237         /* 16 digits plus a leading "0x" plus a null terminator,
 238          * should be good for 64-bit or smaller ints */
 239         char *p = &local[22];
 240         *--p = '\0';
 241         do {
 242                 char temp = i & 0xf;
 243                 if (temp <= 0x09)
 244                     *--p = '0' + temp;
 245                 else
 246                     *--p = 'a' - 0x0a + temp;
 247                 i >>= 4;
 248         } while (i > 0);
 249         *--p = 'x';
 250         *--p = '0';
 251         return p;
 252 }
 253
 254
 255
 256
 257 /* The following macros may be used in dl-startup.c to debug
 258  * ldso before ldso has fixed itself up to make function calls */
 259
 260 /* On some (wierd) arches, none of this stuff works at all, so
 261  * disable the whole lot... */
 262 #if defined(__mips__)
 263
 264 # define SEND_STDERR(X)
 265 # define SEND_ADDRESS_STDERR(X, add_a_newline)
 266 # define SEND_NUMBER_STDERR(X, add_a_newline)
 267
 268 #else
 269
 270 /* On some arches constant strings are referenced through the GOT.
 271  * This requires that load_addr must already be defined... */
 272 #if defined(mc68000) || defined(__arm__) || defined(__mips__)   \
 273                      || defined(__sh__) ||  defined(__powerpc__)
 274 # define CONSTANT_STRING_GOT_FIXUP(X) \
 275         if ((X) < (const char *) load_addr) (X) += load_addr
 276 #else
 277 # define CONSTANT_STRING_GOT_FIXUP(X)
 278 #endif
 279
 280 #define SEND_STDERR(X) \
 281 { \
 282         const char *tmp1 = (X); \
 283         CONSTANT_STRING_GOT_FIXUP(tmp1); \
 284         _dl_write(2, tmp1, _dl_strlen(tmp1)); \
 285 }
 286
 287 #define SEND_ADDRESS_STDERR(ADR, add_a_newline) \
 288 { \
 289         char tmp[26], v, *tmp2, *tmp1 = tmp; \
 290         unsigned long X = (unsigned long)(ADR); \
 291         CONSTANT_STRING_GOT_FIXUP(tmp1); \
 292         tmp2 = tmp1 + sizeof(tmp); \
 293         *--tmp2 = '\0'; \
 294         if (add_a_newline) *--tmp2 = '\n'; \
 295         do { \
 296                 v = (X) & 0xf; \
 297                 if (v <= 0x09) \
 298                         *--tmp2 = '0' + v; \
 299                 else \
 300                         *--tmp2 = 'a' - 0x0a + v; \
 301                 (X) >>= 4; \
 302         } while ((X) > 0); \
 303         *--tmp2 = 'x'; \
 304         *--tmp2 = '0'; \
 305         _dl_write(2, tmp2, tmp1 - tmp2 + sizeof(tmp) - 1); \
 306 }
 307
 308 #define SEND_NUMBER_STDERR(X, add_a_newline) \
 309 { \
 310         char tmp[26], v, *tmp2, *tmp1 = tmp; \
 311         CONSTANT_STRING_GOT_FIXUP(tmp1); \
 312         tmp2 = tmp1 + sizeof(tmp); \
 313         *--tmp2 = '\0'; \
 314         if (add_a_newline) *--tmp2 = '\n'; \
 315         do { \
 316                 do_rem(v, (X), 10); \
 317                 *--tmp2 = '0' + v; \
 318                 (X) /= 10; \
 319         } while ((X) > 0); \
 320         _dl_write(2, tmp2, tmp1 - tmp2 + sizeof(tmp) - 1); \
 321 }
 322 #endif
 323
 324 #ifdef __SUPPORT_LD_DEBUG_EARLY__
 325 # define SEND_STDERR_DEBUG(X) SEND_STDERR(X)
 326 # define SEND_ADDRESS_STDERR_DEBUG(X, add_a_newline) SEND_ADDRESS_STDERR(X, add_a_newline)
 327 #else
 328 # define SEND_STDERR_DEBUG(X)
 329 # define SEND_ADDRESS_STDERR_DEBUG(X, add_a_newline)
 330 #endif
 331
 332 #endif