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
|
#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 <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) __a = (a); \
__typeof__(b) __b = (b); \
__a < __b ? __a : __b; \
})
/* Return the bigger value of 'a' and 'b'. */
#define max(a, b) ({ \
__typeof__(a) __a = (a); \
__typeof__(b) __b = (b); \
__a > __b ? __a : __b; \
})
/* 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 integer 'n' up to a multiple of 's'. */
#define round_up(n, s) ((((n) + (s) - 1) / (s)) * (s))
/* Perform a ceiling division of 'x' / 'd'. */
#define div_round_up(x, d) ({ \
__typeof__(x) __x = (x); \
__typeof__(d) __d = (d); \
(__x + __d - 1) / __d; \
})
/* Divide unsigned integer x by unsigned integer d and
* round to the closest result. */
#define div_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)
/* Helper to efficiently convert a bit number to
* the corresponding bit mask.
* Resolves at compile-time, if bitnr is a compile-time constant.
* Uses an efficient table lookup otherwise.
*/
extern const uint8_t PROGMEM _bit_to_mask8[8];
#define BITMASK8(bitnr) ( \
__builtin_constant_p(bitnr) ? \
(1 << (bitnr)) : \
pgm_read_byte(&_bit_to_mask8[(bitnr)]) \
)
/* Return the number of elements in a C array. */
#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
/* Progmem pointer annotation. */
#define PROGPTR /* progmem pointer */
/* 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
/* Boolean type. */
typedef _Bool bool;
void reboot(void) noreturn;
void panic(void) noreturn;
#define PANIC_ON(condition) do { if (condition) panic(); } while (0)
void eeprom_read_block_wdtsafe(void *_dst, const void *_src, size_t n);
void eeprom_update_block_wdtsafe(const void *_src, void *dst, size_t n);
/* 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);
}
#endif /* MY_UTIL_H_ */
|
