Loading...
1/*
2 * linux/arch/arm/lib/findbit.S
3 *
4 * Copyright (C) 1995-2000 Russell King
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 *
10 * 16th March 2001 - John Ripley <jripley@sonicblue.com>
11 * Fixed so that "size" is an exclusive not an inclusive quantity.
12 * All users of these functions expect exclusive sizes, and may
13 * also call with zero size.
14 * Reworked by rmk.
15 */
16#include <linux/linkage.h>
17#include <asm/assembler.h>
18 .text
19
20/*
21 * Purpose : Find a 'zero' bit
22 * Prototype: int find_first_zero_bit(void *addr, unsigned int maxbit);
23 */
24ENTRY(_find_first_zero_bit_le)
25 teq r1, #0
26 beq 3f
27 mov r2, #0
281:
29 ARM( ldrb r3, [r0, r2, lsr #3] )
30 THUMB( lsr r3, r2, #3 )
31 THUMB( ldrb r3, [r0, r3] )
32 eors r3, r3, #0xff @ invert bits
33 bne .L_found @ any now set - found zero bit
34 add r2, r2, #8 @ next bit pointer
352: cmp r2, r1 @ any more?
36 blo 1b
373: mov r0, r1 @ no free bits
38 mov pc, lr
39ENDPROC(_find_first_zero_bit_le)
40
41/*
42 * Purpose : Find next 'zero' bit
43 * Prototype: int find_next_zero_bit(void *addr, unsigned int maxbit, int offset)
44 */
45ENTRY(_find_next_zero_bit_le)
46 teq r1, #0
47 beq 3b
48 ands ip, r2, #7
49 beq 1b @ If new byte, goto old routine
50 ARM( ldrb r3, [r0, r2, lsr #3] )
51 THUMB( lsr r3, r2, #3 )
52 THUMB( ldrb r3, [r0, r3] )
53 eor r3, r3, #0xff @ now looking for a 1 bit
54 movs r3, r3, lsr ip @ shift off unused bits
55 bne .L_found
56 orr r2, r2, #7 @ if zero, then no bits here
57 add r2, r2, #1 @ align bit pointer
58 b 2b @ loop for next bit
59ENDPROC(_find_next_zero_bit_le)
60
61/*
62 * Purpose : Find a 'one' bit
63 * Prototype: int find_first_bit(const unsigned long *addr, unsigned int maxbit);
64 */
65ENTRY(_find_first_bit_le)
66 teq r1, #0
67 beq 3f
68 mov r2, #0
691:
70 ARM( ldrb r3, [r0, r2, lsr #3] )
71 THUMB( lsr r3, r2, #3 )
72 THUMB( ldrb r3, [r0, r3] )
73 movs r3, r3
74 bne .L_found @ any now set - found zero bit
75 add r2, r2, #8 @ next bit pointer
762: cmp r2, r1 @ any more?
77 blo 1b
783: mov r0, r1 @ no free bits
79 mov pc, lr
80ENDPROC(_find_first_bit_le)
81
82/*
83 * Purpose : Find next 'one' bit
84 * Prototype: int find_next_zero_bit(void *addr, unsigned int maxbit, int offset)
85 */
86ENTRY(_find_next_bit_le)
87 teq r1, #0
88 beq 3b
89 ands ip, r2, #7
90 beq 1b @ If new byte, goto old routine
91 ARM( ldrb r3, [r0, r2, lsr #3] )
92 THUMB( lsr r3, r2, #3 )
93 THUMB( ldrb r3, [r0, r3] )
94 movs r3, r3, lsr ip @ shift off unused bits
95 bne .L_found
96 orr r2, r2, #7 @ if zero, then no bits here
97 add r2, r2, #1 @ align bit pointer
98 b 2b @ loop for next bit
99ENDPROC(_find_next_bit_le)
100
101#ifdef __ARMEB__
102
103ENTRY(_find_first_zero_bit_be)
104 teq r1, #0
105 beq 3f
106 mov r2, #0
1071: eor r3, r2, #0x18 @ big endian byte ordering
108 ARM( ldrb r3, [r0, r3, lsr #3] )
109 THUMB( lsr r3, #3 )
110 THUMB( ldrb r3, [r0, r3] )
111 eors r3, r3, #0xff @ invert bits
112 bne .L_found @ any now set - found zero bit
113 add r2, r2, #8 @ next bit pointer
1142: cmp r2, r1 @ any more?
115 blo 1b
1163: mov r0, r1 @ no free bits
117 mov pc, lr
118ENDPROC(_find_first_zero_bit_be)
119
120ENTRY(_find_next_zero_bit_be)
121 teq r1, #0
122 beq 3b
123 ands ip, r2, #7
124 beq 1b @ If new byte, goto old routine
125 eor r3, r2, #0x18 @ big endian byte ordering
126 ARM( ldrb r3, [r0, r3, lsr #3] )
127 THUMB( lsr r3, #3 )
128 THUMB( ldrb r3, [r0, r3] )
129 eor r3, r3, #0xff @ now looking for a 1 bit
130 movs r3, r3, lsr ip @ shift off unused bits
131 bne .L_found
132 orr r2, r2, #7 @ if zero, then no bits here
133 add r2, r2, #1 @ align bit pointer
134 b 2b @ loop for next bit
135ENDPROC(_find_next_zero_bit_be)
136
137ENTRY(_find_first_bit_be)
138 teq r1, #0
139 beq 3f
140 mov r2, #0
1411: eor r3, r2, #0x18 @ big endian byte ordering
142 ARM( ldrb r3, [r0, r3, lsr #3] )
143 THUMB( lsr r3, #3 )
144 THUMB( ldrb r3, [r0, r3] )
145 movs r3, r3
146 bne .L_found @ any now set - found zero bit
147 add r2, r2, #8 @ next bit pointer
1482: cmp r2, r1 @ any more?
149 blo 1b
1503: mov r0, r1 @ no free bits
151 mov pc, lr
152ENDPROC(_find_first_bit_be)
153
154ENTRY(_find_next_bit_be)
155 teq r1, #0
156 beq 3b
157 ands ip, r2, #7
158 beq 1b @ If new byte, goto old routine
159 eor r3, r2, #0x18 @ big endian byte ordering
160 ARM( ldrb r3, [r0, r3, lsr #3] )
161 THUMB( lsr r3, #3 )
162 THUMB( ldrb r3, [r0, r3] )
163 movs r3, r3, lsr ip @ shift off unused bits
164 bne .L_found
165 orr r2, r2, #7 @ if zero, then no bits here
166 add r2, r2, #1 @ align bit pointer
167 b 2b @ loop for next bit
168ENDPROC(_find_next_bit_be)
169
170#endif
171
172/*
173 * One or more bits in the LSB of r3 are assumed to be set.
174 */
175.L_found:
176#if __LINUX_ARM_ARCH__ >= 5
177 rsb r0, r3, #0
178 and r3, r3, r0
179 clz r3, r3
180 rsb r3, r3, #31
181 add r0, r2, r3
182#else
183 tst r3, #0x0f
184 addeq r2, r2, #4
185 movne r3, r3, lsl #4
186 tst r3, #0x30
187 addeq r2, r2, #2
188 movne r3, r3, lsl #2
189 tst r3, #0x40
190 addeq r2, r2, #1
191 mov r0, r2
192#endif
193 cmp r1, r0 @ Clamp to maxbit
194 movlo r0, r1
195 mov pc, lr
196
1/*
2 * linux/arch/arm/lib/findbit.S
3 *
4 * Copyright (C) 1995-2000 Russell King
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 *
10 * 16th March 2001 - John Ripley <jripley@sonicblue.com>
11 * Fixed so that "size" is an exclusive not an inclusive quantity.
12 * All users of these functions expect exclusive sizes, and may
13 * also call with zero size.
14 * Reworked by rmk.
15 */
16#include <linux/linkage.h>
17#include <asm/assembler.h>
18 .text
19
20/*
21 * Purpose : Find a 'zero' bit
22 * Prototype: int find_first_zero_bit(void *addr, unsigned int maxbit);
23 */
24ENTRY(_find_first_zero_bit_le)
25 teq r1, #0
26 beq 3f
27 mov r2, #0
281:
29 ARM( ldrb r3, [r0, r2, lsr #3] )
30 THUMB( lsr r3, r2, #3 )
31 THUMB( ldrb r3, [r0, r3] )
32 eors r3, r3, #0xff @ invert bits
33 bne .L_found @ any now set - found zero bit
34 add r2, r2, #8 @ next bit pointer
352: cmp r2, r1 @ any more?
36 blo 1b
373: mov r0, r1 @ no free bits
38 ret lr
39ENDPROC(_find_first_zero_bit_le)
40
41/*
42 * Purpose : Find next 'zero' bit
43 * Prototype: int find_next_zero_bit(void *addr, unsigned int maxbit, int offset)
44 */
45ENTRY(_find_next_zero_bit_le)
46 teq r1, #0
47 beq 3b
48 ands ip, r2, #7
49 beq 1b @ If new byte, goto old routine
50 ARM( ldrb r3, [r0, r2, lsr #3] )
51 THUMB( lsr r3, r2, #3 )
52 THUMB( ldrb r3, [r0, r3] )
53 eor r3, r3, #0xff @ now looking for a 1 bit
54 movs r3, r3, lsr ip @ shift off unused bits
55 bne .L_found
56 orr r2, r2, #7 @ if zero, then no bits here
57 add r2, r2, #1 @ align bit pointer
58 b 2b @ loop for next bit
59ENDPROC(_find_next_zero_bit_le)
60
61/*
62 * Purpose : Find a 'one' bit
63 * Prototype: int find_first_bit(const unsigned long *addr, unsigned int maxbit);
64 */
65ENTRY(_find_first_bit_le)
66 teq r1, #0
67 beq 3f
68 mov r2, #0
691:
70 ARM( ldrb r3, [r0, r2, lsr #3] )
71 THUMB( lsr r3, r2, #3 )
72 THUMB( ldrb r3, [r0, r3] )
73 movs r3, r3
74 bne .L_found @ any now set - found zero bit
75 add r2, r2, #8 @ next bit pointer
762: cmp r2, r1 @ any more?
77 blo 1b
783: mov r0, r1 @ no free bits
79 ret lr
80ENDPROC(_find_first_bit_le)
81
82/*
83 * Purpose : Find next 'one' bit
84 * Prototype: int find_next_zero_bit(void *addr, unsigned int maxbit, int offset)
85 */
86ENTRY(_find_next_bit_le)
87 teq r1, #0
88 beq 3b
89 ands ip, r2, #7
90 beq 1b @ If new byte, goto old routine
91 ARM( ldrb r3, [r0, r2, lsr #3] )
92 THUMB( lsr r3, r2, #3 )
93 THUMB( ldrb r3, [r0, r3] )
94 movs r3, r3, lsr ip @ shift off unused bits
95 bne .L_found
96 orr r2, r2, #7 @ if zero, then no bits here
97 add r2, r2, #1 @ align bit pointer
98 b 2b @ loop for next bit
99ENDPROC(_find_next_bit_le)
100
101#ifdef __ARMEB__
102
103ENTRY(_find_first_zero_bit_be)
104 teq r1, #0
105 beq 3f
106 mov r2, #0
1071: eor r3, r2, #0x18 @ big endian byte ordering
108 ARM( ldrb r3, [r0, r3, lsr #3] )
109 THUMB( lsr r3, #3 )
110 THUMB( ldrb r3, [r0, r3] )
111 eors r3, r3, #0xff @ invert bits
112 bne .L_found @ any now set - found zero bit
113 add r2, r2, #8 @ next bit pointer
1142: cmp r2, r1 @ any more?
115 blo 1b
1163: mov r0, r1 @ no free bits
117 ret lr
118ENDPROC(_find_first_zero_bit_be)
119
120ENTRY(_find_next_zero_bit_be)
121 teq r1, #0
122 beq 3b
123 ands ip, r2, #7
124 beq 1b @ If new byte, goto old routine
125 eor r3, r2, #0x18 @ big endian byte ordering
126 ARM( ldrb r3, [r0, r3, lsr #3] )
127 THUMB( lsr r3, #3 )
128 THUMB( ldrb r3, [r0, r3] )
129 eor r3, r3, #0xff @ now looking for a 1 bit
130 movs r3, r3, lsr ip @ shift off unused bits
131 bne .L_found
132 orr r2, r2, #7 @ if zero, then no bits here
133 add r2, r2, #1 @ align bit pointer
134 b 2b @ loop for next bit
135ENDPROC(_find_next_zero_bit_be)
136
137ENTRY(_find_first_bit_be)
138 teq r1, #0
139 beq 3f
140 mov r2, #0
1411: eor r3, r2, #0x18 @ big endian byte ordering
142 ARM( ldrb r3, [r0, r3, lsr #3] )
143 THUMB( lsr r3, #3 )
144 THUMB( ldrb r3, [r0, r3] )
145 movs r3, r3
146 bne .L_found @ any now set - found zero bit
147 add r2, r2, #8 @ next bit pointer
1482: cmp r2, r1 @ any more?
149 blo 1b
1503: mov r0, r1 @ no free bits
151 ret lr
152ENDPROC(_find_first_bit_be)
153
154ENTRY(_find_next_bit_be)
155 teq r1, #0
156 beq 3b
157 ands ip, r2, #7
158 beq 1b @ If new byte, goto old routine
159 eor r3, r2, #0x18 @ big endian byte ordering
160 ARM( ldrb r3, [r0, r3, lsr #3] )
161 THUMB( lsr r3, #3 )
162 THUMB( ldrb r3, [r0, r3] )
163 movs r3, r3, lsr ip @ shift off unused bits
164 bne .L_found
165 orr r2, r2, #7 @ if zero, then no bits here
166 add r2, r2, #1 @ align bit pointer
167 b 2b @ loop for next bit
168ENDPROC(_find_next_bit_be)
169
170#endif
171
172/*
173 * One or more bits in the LSB of r3 are assumed to be set.
174 */
175.L_found:
176#if __LINUX_ARM_ARCH__ >= 5
177 rsb r0, r3, #0
178 and r3, r3, r0
179 clz r3, r3
180 rsb r3, r3, #31
181 add r0, r2, r3
182#else
183 tst r3, #0x0f
184 addeq r2, r2, #4
185 movne r3, r3, lsl #4
186 tst r3, #0x30
187 addeq r2, r2, #2
188 movne r3, r3, lsl #2
189 tst r3, #0x40
190 addeq r2, r2, #1
191 mov r0, r2
192#endif
193 cmp r1, r0 @ Clamp to maxbit
194 movlo r0, r1
195 ret lr
196