4 * This file is part of BeRTOS.
6 * Bertos 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.
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.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
20 * As a special exception, you may use this file as part of a free software
21 * library without restriction. Specifically, if other files instantiate
22 * templates or use macros or inline functions from this file, or you compile
23 * this file and link it with other files to produce an executable, this
24 * file does not by itself cause the resulting executable to be covered by
25 * the GNU General Public License. This exception does not however
26 * invalidate any other reasons why the executable file might be covered by
27 * the GNU General Public License.
29 * Copyright 2003, 2004 Develer S.r.l. (http://www.develer.com/)
33 * \brief Common and handy function macros
35 * \author Bernie Innocenti <bernie@codewiz.org>
36 * \author Giovanni Bajo <rasky@develer.com>
41 #include <cfg/compiler.h>
43 /* avr-gcc does not seem to support libstdc++ */
44 #if defined(__cplusplus) && !CPU_AVR
45 /* Type-generic macros implemented with template functions. */
48 template<class T> inline T ABS(T n) { return n >= 0 ? n : -n; }
49 #define MIN(a,b) std::min(a, b)
50 #define MAX(a,b) std::max(a, b)
51 #define SWAP(a,b) std::swap(a, b)
52 #elif (COMPILER_STATEMENT_EXPRESSIONS && COMPILER_TYPEOF)
53 /* Type-generic macros implemented with statement expressions. */
56 (_n < 0) ? -_n : _n; \
61 ASSERT_TYPE_EQUAL(_a, _b); \
63 * The (typeof(_a)) cast in necessary: \
64 * result type of conditional expressions is \
65 * *NOT* the type of the value returned but \
66 * the type that would be produced if _a and _b \
67 * were mixed in an expression. \
68 * Even in _a and _b are of the same type, \
69 * if mixed in an expression the type will be \
70 * (at least) promoted to int! \
72 ((typeof(_a))((_a < _b) ? _a : _b)); \
77 ASSERT_TYPE_EQUAL(_a, _b); \
79 * The (typeof(_a)) cast in necessary: \
80 * result type of conditional expressions is \
81 * *NOT* the type of the value returned but \
82 * the type that would be produced if _a and _b \
83 * were mixed in an expression. \
84 * Even in _a and _b are of the same type, \
85 * if mixed in an expression the type will be \
86 * (at least) promoted to int! \
88 ((typeof(_a))((_a > _b) ? _a : _b)); \
90 #else /* !(COMPILER_STATEMENT_EXPRESSIONS && COMPILER_TYPEOF) */
91 /* Buggy macros for inferior compilers. */
92 #define ABS(a) (((a) < 0) ? -(a) : (a))
93 #define MIN(a,b) (((a) < (b)) ? (a) : (b))
94 #define MAX(a,b) (((a) > (b)) ? (a) : (b))
95 #endif /* !(COMPILER_STATEMENT_EXPRESSIONS && COMPILER_TYPEOF) */
97 /** Align \p value to the next \p align boundary */
98 #define ALIGN_UP(value, align) (((value) & ((align) - 1)) ? \
99 (((value) + ((align) - 1)) & ~((align) - 1)) : \
102 /** Bound \a x between \a min and \a max. */
103 #define MINMAX(min,x,max) (MIN(MAX(min, x), max))
106 /* Use standard implementation from <algorithm> */
107 #define SWAP(a,b) std::swap(a, b)
108 #elif COMPILER_TYPEOF
110 * Type-generic macro to swap \a a with \a b.
112 * \note Arguments are evaluated multiple times.
117 ASSERT_TYPE_EQUAL(a, b); \
122 #else /* !COMPILER_TYPEOF */
123 /* Sub-optimal implementation that only works with integral types. */
131 #endif /* COMPILER_TYPEOF */
134 * Shuffle the content of \a array that counts \a len elements.
136 #define SHUFFLE(array, len) \
139 for (i = (len) - 1; i > 0; i--) \
141 j = ((i + 1) * (rand() / (RAND_MAX + 1.0))); \
142 SWAP((array)[i], (array)[j]); \
147 * Macro to swap \a a with \a b, with explicit type \a T for dumb C89 compilers.
149 * \note Arguments are evaluated multiple times.
151 #define SWAP_T(a, b, T) \
154 ASSERT_TYPE_IS(a, T); \
155 ASSERT_TYPE_IS(b, T); \
162 * Reverse the bits contained in b (LSB becomes the MSB and so on).
163 * \note \a b is evaluated twice
165 #define REVERSE_UINT8(b) \
166 ((uint8_t)((((b) * 0x0802UL & 0x22110UL) | ((b) * 0x8020UL & 0x88440UL)) * 0x10101UL >> 16))
169 /** Convert a bit value to a binary flag. */
170 #define BV(x) (1<<(x))
173 /** Same as BV() but with 32 bit result */
174 #define BV32(x) ((uint32_t)1<<(x))
176 /** Same as BV() but with 16 bit result */
177 #define BV16(x) ((uint16_t)1<<(x))
179 /** Same as BV() but with 8 bit result */
180 #define BV8(x) ((uint8_t)1<<(x))
183 * Perform an integer division rounding the result to the nearest int value.
184 * \note \a divisor should preferibly be a costant, otherwise this macro generates
185 * 2 division. Also divisor is evaluated twice.
187 #define DIV_ROUND(dividend, divisor) (((dividend) + (divisor) / 2) / (divisor))
190 * Perform an integer division rounding the result to the upper int value.
191 * \note \a divisor should preferibly be a costant, otherwise this macro generates
192 * 2 division. Also divisor is evaluated twice.
194 #define DIV_ROUNDUP(dividend, divisor) (((dividend) + (divisor) - 1) / (divisor))
196 /** Round up \a x to an even multiple of the 2's power \a pad. */
197 #define ROUND_UP2(x, pad) (((x) + ((pad) - 1)) & ~((pad) - 1))
200 * \name Integer round macros.
202 * Round \a x to a multiple of \a base.
203 * \note If \a x is signed these macros generate a lot of code.
206 #define ROUND_DOWN(x, base) ( (x) - ((x) % (base)) )
207 #define ROUND_UP(x, base) ( ((x) + (base) - 1) - (((x) + (base) - 1) % (base)) )
208 #define ROUND_NEAREST(x, base) ( ((x) + (base) / 2) - (((x) + (base) / 2) % (base)) )
211 /** Check if \a x is an integer power of 2. */
212 #define IS_POW2(x) (!(bool)((x) & ((x)-1)))
214 /** Calculate a compile-time log2 for a uint8_t */
215 #define UINT8_LOG2(x) \
222 ((x) < 128 ? 6 : 7)))))))
224 /** Calculate a compile-time log2 for a uint16_t */
225 #define UINT16_LOG2(x) \
226 ((x < 256) ? UINT8_LOG2(x) : UINT8_LOG2((x) >> 8) + 8)
228 /** Calculate a compile-time log2 for a uint32_t */
229 #define UINT32_LOG2(x) \
230 ((x < 65536UL) ? UINT16_LOG2(x) : UINT16_LOG2((x) >> 16) + 16)
232 #if COMPILER_VARIADIC_MACROS
233 /** Count the number of arguments (up to 16). */
234 #define PP_COUNT(...) \
235 PP_COUNT__(__VA_ARGS__,16,15,14,13,12,11,10,9,8,7,6,5,4,3,2,1,0)
236 #define PP_COUNT__(a0,a1,a2,a3,a4,a5,a6,a7,a8,a9,a10,a11,a12,a13,a14,a15,count,...) \
240 #if COMPILER_VARIADIC_MACROS
242 * \def BIT_CHANGE(reg, (mask, value), ...)
244 * This macro allows for efficient and compact bit toggling in a hardware
245 * register. It is meant to replace hand-coded cruft which toggles bits
248 * It is possible to specify an unlimited pair of (mask, value) parameters.
252 * void set_timer(bool start)
254 * BIT_CHANGE(REG_CTRL_TIMER,
255 * (TIMER_MODE, MODE_COUNT),
263 * The macro expansion will be roughly the following:
266 * REG_CTRL_TIMER = (REG_CTRL_TIMER & ~(TIMER_MODE|OVL_IRQ|CMP_IRQ|START)
267 * | (MODE_COUNT|OVL_IRQ|CMP_IRQ|(start ? START : 0));
270 * It is up to the compiler to produce the optimal code. We checked that GCC produces
271 * the best code in most cases. We preferred this expansion over the use of a block
272 * with a local variable because CodeWarrior 6.1 was not able to remove completely the
273 * allocation of the local from the stack.
275 * \note This macro is available only in C99 because it makes use of variadic macros.
276 * It would be possible to make up an implementation with a slightly different syntax
277 * for use with C90 compilers, through Boost Preprocessor.
281 * \def BIT_CHANGE_BV(reg, (bit, value), ...)
283 * Similar to BIT_CHANGE(), but get bits instead of masks (and applies BV() to convert
287 #define BIT_EXTRACT_FLAG_0(bit, value) bit
288 #define BIT_EXTRACT_FLAG_1(bit, value) BV(bit)
289 #define BIT_EXTRACT_VALUE__(bit, value) value
291 #define BIT_MASK_SINGLE__(use_bv, index, max, arg) \
292 ((index < max) ? (PP_CAT(BIT_EXTRACT_FLAG_, use_bv) arg) : 0) \
295 #define BIT_MASK_IF_SINGLE__(use_bv, index, max, arg) \
296 (((index < max) && (BIT_EXTRACT_VALUE__ arg)) ? (PP_CAT(BIT_EXTRACT_FLAG_, use_bv) arg) : 0) \
299 #define BIT_ITER__2(macro, use_bv, max, a0,a1,a2,a3,a4,a5,a6,a7,a8,a9,a10,a11,a12,a13,a14,a15, ...) \
300 (macro(use_bv, 0, max, a0) | \
301 macro(use_bv, 1, max, a1) | \
302 macro(use_bv, 2, max, a2) | \
303 macro(use_bv, 3, max, a3) | \
304 macro(use_bv, 4, max, a4) | \
305 macro(use_bv, 5, max, a5) | \
306 macro(use_bv, 6, max, a6) | \
307 macro(use_bv, 7, max, a7) | \
308 macro(use_bv, 8, max, a8) | \
309 macro(use_bv, 9, max, a9) | \
310 macro(use_bv, 10, max, a10) | \
311 macro(use_bv, 11, max, a11) | \
312 macro(use_bv, 12, max, a12) | \
313 macro(use_bv, 13, max, a13) | \
314 macro(use_bv, 14, max, a14) | \
315 macro(use_bv, 15, max, a15)) \
318 #define BIT_ITER__(macro, use_bv, ...) \
319 BIT_ITER__2(macro, use_bv, PP_COUNT(__VA_ARGS__), __VA_ARGS__, (0,1),(0,1),(0,1),(0,1),(0,1),(0,1),(0,1),(0,1),(0,1),(0,1),(0,1),(0,1),(0,1),(0,1),(0,1),(0,1)) \
322 #define BIT_MASKS__(use_bv, ...) \
323 BIT_ITER__(BIT_MASK_SINGLE__, use_bv, __VA_ARGS__)
326 #define BIT_MASKS_CONDITIONAL__(use_bv, ...) \
327 BIT_ITER__(BIT_MASK_IF_SINGLE__, use_bv, __VA_ARGS__)
330 #define BIT_CHANGE__(reg, use_bv, ...) \
331 ((reg) = ((reg) & ~BIT_MASKS__(use_bv, __VA_ARGS__)) | BIT_MASKS_CONDITIONAL__(use_bv, __VA_ARGS__)) \
334 #define BIT_CHANGE(reg, ...) BIT_CHANGE__(reg, 0, __VA_ARGS__)
335 #define BIT_CHANGE_BV(reg, ...) BIT_CHANGE__(reg, 1, __VA_ARGS__)
337 #endif /* COMPILER_VARIADIC_MACROS */
340 * Macro for rotating bit left or right.
343 #define ROTR(var, rot) (((var) >> (rot)) | ((var) << ((sizeof(var) * 8) - (rot))))
344 #define ROTL(var, rot) (((var) << (rot)) | ((var) >> ((sizeof(var) * 8) - (rot))))
348 * Make an id from 4 letters, useful for
349 * file formats and kfile ids.
351 #define MAKE_ID(a,b,c,d) \
352 ( ((uint32_t)(a) << 24) \
353 | ((uint32_t)(b) << 16) \
354 | ((uint32_t)(c) << 8) \
355 | ((uint32_t)(d) << 0) )
358 * Type for id generated by MAKE_ID().
360 typedef uint32_t id_t;
362 #endif /* MACROS_H */