Initial commit, code based on LPC1224 support and LPC812-MAX CMSIS-DAP interface...
[lpc11u3x] / lib / utils.c
1 /****************************************************************************
2  *  lib/utils.c
3  *
4  * Copyright 2014 Nathael Pajani <nathael.pajani@ed3l.fr>
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 as published by
8  * the Free Software Foundation, either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
18  *
19  *************************************************************************** */
21 #include <stdint.h>
24 /***************************************************************************** */
25 /* Bit twidling hacks.
26  * http://graphics.stanford.edu/~seander/bithacks.html
27  */
29 /* Counting consecutive trailing or leading zero bits (or finding bit indices)
30  * The ARM Cortex M0 core does not have the __builtin_clz() and __builtin_ctz()
31  * instructions.
32  */
34 /* Count leading zeroes
35  * The following function is an effitient way to implement __builtin_clz().
36  */
37 uint8_t clz(uint32_t x)
38 {
39         static const uint8_t bval[] = {0,1,2,2,3,3,3,3,4,4,4,4,4,4,4,4};
40         unsigned int r = 32;
41         if (x >= 0x10000) { /* Quicker than (x & 0xFFFF0000) on a 32bit arm arch */
42                 r -= 16;
43                 x >>= 16;
44         }
45         if (x & 0xFF00) {
46                 r -= 8;
47                 x >>= 8;
48         }
49         if (x & 0xF0) {
50                 r -= 4;
51                 x >>= 4;
52         }
53         return r - bval[x];
54 }
56 /* Count traling zeroes
57  * The following function is an effitient way to implement __builtin_ctz().
58  */
59 uint8_t ctz(uint32_t x)
60 {
61         static const uint8_t bval[] = {4,0,1,0,2,0,1,0,3,0,1,0,2,0,1,0};
62         unsigned int r = 0;
63         if (x & 0x1) {
64                 /* special case for odd value (assumed to happen half of the time) */
65                 return r;
66         }
67         if ((x & 0xFFFF) == 0) {
68                 r += 16;
69                 x >>= 16;
70         }
71         if ((x & 0xFF) == 0) {
72                 r += 8;
73                 x >>= 8;
74         }
75         if ((x & 0xF) == 0) {
76                 r += 4;
77                 x >>= 4;
78         }
79         return r + bval[(x & 0x0F)];
80 }