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
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
|
#ifndef MY_UTIL_H_
#define MY_UTIL_H_
#ifndef F_CPU
# warning "F_CPU not defined"
#endif
#include <util/delay.h>
#include <stdlib.h>
#include <stdint.h>
#include <stdbool.h>
#include <avr/interrupt.h>
#include <avr/pgmspace.h>
#include <avr/cpufunc.h>
/* Return the smaller value of 'a' and 'b'. */
#define min(a, b) ({ \
__typeof__(a) __amin = (a); \
__typeof__(b) __bmin = (b); \
(__typeof__(a))(__amin < __bmin ? __amin : __bmin); \
})
/* Return the bigger value of 'a' and 'b'. */
#define max(a, b) ({ \
__typeof__(a) __amax = (a); \
__typeof__(b) __bmax = (b); \
(__typeof__(a))(__amax > __bmax ? __amax : __bmax); \
})
/* Return 'value' clamped inbetween 'min_val' and 'max_val'. */
#define clamp(value, min_val, max_val) \
max(min(value, max_val), min_val)
/* Return the absolute value of 'val' */
#undef abs
#define abs(val) ({ \
__typeof__(val) __val = (val); \
__val >= 0 ? __val : -__val; \
})
/* Round an unsigned integer 'n' up to a multiple of 's'. */
#define round_up(n, s) ((((n) + (s) - 1) / (s)) * (s))
/* Perform a signed ceiling division of 'x' / 'd'. */
#define sdiv_round_up(x, d) ({ \
__typeof__(x) __r, __x = (x); \
__typeof__(d) __d = (d); \
if ((__x < 0) ^ (__d < 0)) \
__r = __x / __d; \
else if ((__x < 0) && (__d < 0)) \
__r = (__x + __d + 1) / __d; \
else \
__r = (__x + __d - 1) / __d; \
__r; \
})
/* Perform an unsigned ceiling division of 'x' / 'd'. */
#define udiv_round_up(x, d) ({ \
__typeof__(x) __x = (x); \
__typeof__(d) __d = (d); \
(__x + __d - 1) / __d; \
})
/* Divide signed integer x by signed integer d and
* round to the closest result. */
#define sdiv_round(x, d) ({ \
__typeof__(x) __r, __x = (x); \
__typeof__(d) __d = (d); \
if ((__x < 0) ^ (__d < 0)) \
__r = (__x - (__d / 2)) / __d; \
else \
__r = (__x + (__d / 2)) / __d; \
__r; \
})
/* Divide unsigned integer x by unsigned integer d and
* round to the closest result. */
#define udiv_round(x, d) ({ \
__typeof__(x) __x = (x); \
__typeof__(d) __d = (d); \
(__x + (__d / 2)) / __d; \
})
/* Swap values 'a' and 'b' in place.
* Also checks whether 'a' and 'b' are of the same type. */
#define swap_values(a, b) do { \
__typeof__(a) __a = (a); \
__typeof__(b) __b = (b); \
__typeof__(a) __tmp = __a; \
(void)((&__a) == (&__b)); \
(a) = __b; \
(b) = __tmp; \
} while (0)
/* Compute b to the power of e. */
int32_t pow_int(int16_t b, uint8_t e);
/* Get the number of elements in a C array. */
#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
/* Get the size of a struct member. */
#define SE_SIZE(_struct, _elem) (sizeof(((_struct *)NULL)->_elem))
/* Get the array size of an array member in a struct. */
#define SEA_SIZE(_struct, _elem_arr) ARRAY_SIZE(((_struct *)NULL)->_elem_arr)
/* Memory barrier. */
#define mb() __asm__ __volatile__("" : : : "memory")
/* Do-not-inline function attribute. */
#define noinline __attribute__((__noinline__))
/* Always-inline function attribute. */
#define alwaysinline inline __attribute__((__always_inline__))
/* Pure-function attribute. */
#define pure_fn __attribute__((__pure__))
/* Const-function attribute. */
#define const_fn __attribute__((__const__))
/* Data structure packing attribute. */
#define _packed __attribute__((__packed__))
/* Build-time assertion.
* 'cond' must be a compile-time constant.
* Build will fail, if 'cond' is false.
*/
#define build_assert(cond) ((void)sizeof(char[1 - 2 * !(cond)]))
/* Code flow attributes */
#define noreturn __attribute__((__noreturn__))
#define _mainfunc __attribute__((__OS_main__))
#if defined(__GNUC__) && __GNUC__ >= 4 && __GNUC_MINOR__ >= 5
# define unreachable() __builtin_unreachable()
#else
# define unreachable() while (1)
#endif
/* Returns true, if the expression is known to be constant at compile time. */
#define is_constant(exp) __builtin_constant_p(exp)
/* Compile-time equivalent to the ?: operator */
#if defined(__GNUC__) && __GNUC__ >= 5 && __GNUC_MINOR__ >= 4
# define choose_expr(cond, exp1, exp2) __builtin_choose_expr(cond, exp1, exp2)
#else
# define choose_expr(cond, exp1, exp2) ((cond) ? (exp1) : (exp2))
#endif
/* Non-standard integer types. */
typedef __int24 int24_t;
typedef __uint24 uint24_t;
#ifndef irq_disable
/* Disable interrupts globally. */
static alwaysinline void irq_disable(void)
{
cli();
mb();
}
#define irq_disable irq_disable
#endif
#ifndef irq_enable
/* Enable interrupts globally. */
static alwaysinline void irq_enable(void)
{
mb();
sei();
}
#define irq_enable irq_enable
#endif
#ifndef irq_disable_save
/* Save flags and disable interrupts globally. */
static alwaysinline uint8_t irq_disable_save(void)
{
uint8_t sreg = SREG;
cli();
mb();
return sreg;
}
#define irq_disable_save irq_disable_save
#endif
#ifndef irq_restore
/* Restore interrupt flags. */
static alwaysinline void irq_restore(uint8_t sreg_flags)
{
mb();
SREG = sreg_flags;
}
#define irq_restore irq_restore
#endif
/* Check whether the interrupt-enable flag is set in 'sreg_flags' */
static alwaysinline bool __irqs_enabled(uint8_t sreg_flags)
{
return !!(sreg_flags & (1 << SREG_I));
}
/* Check whether interrupts are enabled globally. */
static alwaysinline bool irqs_enabled(void)
{
return __irqs_enabled(SREG);
}
/* Indirect special function register access. */
#ifndef sfr_addr_t
typedef uint16_t sfr_addr_t;
#define sfr_addr_t sfr_addr_t
#endif
#define SFR_ADDR(sfr) _SFR_ADDR(sfr)
#define SFR_BYTE(sfr_addr) _MMIO_BYTE(sfr_addr)
#endif /* MY_UTIL_H_ */
|
