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
|
#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__))
/* 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
/* Non-standard integer types. */
typedef __int24 int24_t;
typedef __uint24 uint24_t;
/* Disable interrupts globally. */
static inline void irq_disable(void)
{
cli();
mb();
}
/* Enable interrupts globally. */
static inline void irq_enable(void)
{
mb();
sei();
}
/* Save flags and disable interrupts globally. */
static inline uint8_t irq_disable_save(void)
{
uint8_t sreg = SREG;
cli();
mb();
return sreg;
}
/* Restore interrupt flags. */
static inline void irq_restore(uint8_t sreg_flags)
{
mb();
SREG = sreg_flags;
}
/* Check whether the interrupt-enable flag is set in 'sreg_flags' */
static inline bool __irqs_enabled(uint8_t sreg_flags)
{
return !!(sreg_flags & (1 << SREG_I));
}
/* Check whether interrupts are enabled globally. */
static inline bool irqs_enabled(void)
{
return __irqs_enabled(SREG);
}
/* Indirect special function register access. */
typedef uint16_t sfr_addr_t;
#define SFR_ADDR(sfr) _SFR_ADDR(sfr)
#define SFR_BYTE(sfr_addr) _MMIO_BYTE(sfr_addr)
#endif /* MY_UTIL_H_ */
|
