ffs.S 1.17 KB
Newer Older
Tony Feng committed
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
#include <linux/linkage.h>

	.register	%g2,#scratch

	.text
	.align	32

ENTRY(ffs)
	brnz,pt	%o0, 1f
	 mov	1, %o1
	retl
	 clr	%o0
	nop
	nop
ENTRY(__ffs)
	sllx	%o0, 32, %g1		/* 1  */
	srlx	%o0, 32, %g2

	clr	%o1			/* 2  */
	movrz	%g1, %g2, %o0

	movrz	%g1, 32, %o1		/* 3  */
1:	clr	%o2

	sllx	%o0, (64 - 16), %g1	/* 4  */
	srlx	%o0, 16, %g2

	movrz	%g1, %g2, %o0		/* 5  */
	clr	%o3

	movrz	%g1, 16, %o2		/* 6  */
	clr	%o4

	and	%o0, 0xff, %g1		/* 7  */
	srlx	%o0, 8, %g2

	movrz	%g1, %g2, %o0		/* 8  */
	clr	%o5

	movrz	%g1, 8, %o3		/* 9  */
	add	%o2, %o1, %o2

	and	%o0, 0xf, %g1		/* 10 */
	srlx	%o0, 4, %g2

	movrz	%g1, %g2, %o0		/* 11 */
	add	%o2, %o3, %o2

	movrz	%g1, 4, %o4		/* 12 */

	and	%o0, 0x3, %g1		/* 13 */
	srlx	%o0, 2, %g2

	movrz	%g1, %g2, %o0		/* 14 */
	add	%o2, %o4, %o2

	movrz	%g1, 2, %o5		/* 15 */

	and	%o0, 0x1, %g1		/* 16 */

	add	%o2, %o5, %o2		/* 17 */
	xor	%g1, 0x1, %g1

	retl				/* 18 */
	 add	%o2, %g1, %o0
ENDPROC(ffs)
ENDPROC(__ffs)

	.section	.popc_6insn_patch, "ax"
	.word		ffs
	brz,pn	%o0, 98f
	 neg	%o0, %g1
	xnor	%o0, %g1, %o1
	popc	%o1, %o0
98:	retl
	 nop
	.word		__ffs
	neg	%o0, %g1
	xnor	%o0, %g1, %o1
	popc	%o1, %o0
	retl
	 sub	%o0, 1, %o0
	nop
	.previous