48 lines
674 B
ArmAsm
48 lines
674 B
ArmAsm
|
/*
|
||
|
|
* Copyright 2005-2009 Analog Devices Inc.
|
||
|
|
*
|
||
|
|
* Licensed under the ADI BSD license or the GPL-2 (or later)
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/linkage.h>
|
||
|
|
|
||
|
|
/* void *memchr(const void *s, int c, size_t n);
|
||
|
|
* R0 = address (s)
|
||
|
|
* R1 = sought byte (c)
|
||
|
|
* R2 = count (n)
|
||
|
|
*
|
||
|
|
* Returns pointer to located character.
|
||
|
|
*/
|
||
|
|
|
||
|
|
.text
|
||
|
|
|
||
|
|
.align 2
|
||
|
|
|
||
|
|
ENTRY(_memchr)
|
||
|
|
P0 = R0; /* P0 = address */
|
||
|
|
P2 = R2; /* P2 = count */
|
||
|
|
R1 = R1.B(Z);
|
||
|
|
CC = R2 == 0;
|
||
|
|
IF CC JUMP .Lfailed;
|
||
|
|
|
||
|
|
.Lbytes:
|
||
|
|
LSETUP (.Lbyte_loop_s, .Lbyte_loop_e) LC0=P2;
|
||
|
|
|
||
|
|
.Lbyte_loop_s:
|
||
|
|
R3 = B[P0++](Z);
|
||
|
|
CC = R3 == R1;
|
||
|
|
IF CC JUMP .Lfound;
|
||
|
|
.Lbyte_loop_e:
|
||
|
|
NOP;
|
||
|
|
|
||
|
|
.Lfailed:
|
||
|
|
R0=0;
|
||
|
|
RTS;
|
||
|
|
|
||
|
|
.Lfound:
|
||
|
|
R0 = P0;
|
||
|
|
R0 += -1;
|
||
|
|
RTS;
|
||
|
|
|
||
|
|
ENDPROC(_memchr)
|