Subversion Repositories or1k

#if defined __thumb__
 
#include "../../string/memchr.c"
 
#else
 
#include <string.h>
#include "xscale.h"
 
void *
memchr (const void *start, int c, size_t len)
{
  const char *str = start;
 
  if (len == 0)
    return 0;
 
  asm (PRELOADSTR ("%0") : : "r" (start));
 
  c &= 0xff;
 
#ifndef __OPTIMIZE_SIZE__
  /* Skip unaligned part.  */
  if ((long)str & 3)
    {
      str--;
      do
	{
	  if (*++str == c)
	    return (void *)str;
	}
      while (((long)str & 3) != 0 && --len > 0);
    }
 
  if (len > 3)
    {
      unsigned int c2 = c + (c << 8);
      c2 += c2 << 16;
 
      /* Load two constants:
         R7 = 0xfefefeff [ == ~(0x80808080 << 1) ]
         R6 = 0x80808080  */
 
      asm (
       "mov	r6, #0x80
	add	r6, r6, #0x8000
	add	r6, r6, r6, lsl #16
	mvn	r7, r6, lsl #1
 
0:
	cmp	%1, #0x7
	bls	1f
 
	ldmia	%0!, { r3, r9 }
"	PRELOADSTR ("%0") "
	sub	%1, %1, #8
	eor	r3, r3, %2
	eor	r9, r9, %2
	add	r2, r3, r7
	add	r8, r9, r7
	bic	r2, r2, r3
	bic	r8, r8,	r9
	and	r1, r2, r6
	and	r9, r8, r6
	orrs	r1, r1, r9
	beq	0b
 
	add	%1, %1, #8
	sub	%0, %0, #8
1:
	cmp	%1, #0x3
	bls	2f
 
	ldr	r3, [%0], #4
"	PRELOADSTR ("%0") "
	sub	%1, %1, #4
	eor	r3, r3, %2
	add	r2, r3, r7
	bic	r2, r2, r3
	ands	r1, r2, r6
	beq	1b
 
	sub	%0, %0, #4
	add	%1, %1, #4
2:
"
       : "=&r" (str), "=&r" (len)
       : "r" (c2), "0" (str), "1" (len)
       : "r1", "r2", "r3", "r6", "r7", "r8", "r9", "cc");
    }
#endif
 
  while (len-- > 0)
    { 
      if (*str == c)
        return (void *)str;
      str++;
    } 
 
  return 0;
}
#endif