summaryrefslogtreecommitdiffstats
path: root/tmk_core/common/wait.h
blob: 0b3fd755a96d9c1a510e2b096192b023377094c4 (plain)
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
#pragma once

#include <inttypes.h>

#ifdef __cplusplus
extern "C" {
#endif

#if defined(__ARMEL__) || defined(__ARMEB__)
#    ifndef __OPTIMIZE__
#        pragma message "Compiler optimizations disabled; wait_cpuclock() won't work as designed"
#    endif

#    define wait_cpuclock(x) wait_cpuclock_allnop(x)

#    define CLOCK_DELAY_NOP8 "nop\n\t nop\n\t nop\n\t nop\n\t   nop\n\t nop\n\t nop\n\t nop\n\t"

__attribute__((always_inline))
static inline void wait_cpuclock_allnop(unsigned int n) { /* n: 1..135 */
    /* The argument n must be a constant expression.
     * That way, compiler optimization will remove unnecessary code. */
    if (n < 1) { return; }
    if (n > 8) {
        unsigned int n8 = n/8;
        n = n - n8*8;
        switch (n8) {
        case 16: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case 15: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case 14: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case 13: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case 12: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case 11: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case 10: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case  9: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case  8: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case  7: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case  6: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case  5: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case  4: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case  3: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case  2: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case  1: asm volatile (CLOCK_DELAY_NOP8::: "memory");
        case  0: break;
        }
    }
    switch (n) {
    case 8: asm volatile ("nop"::: "memory");
    case 7: asm volatile ("nop"::: "memory");
    case 6: asm volatile ("nop"::: "memory");
    case 5: asm volatile ("nop"::: "memory");
    case 4: asm volatile ("nop"::: "memory");
    case 3: asm volatile ("nop"::: "memory");
    case 2: asm volatile ("nop"::: "memory");
    case 1: asm volatile ("nop"::: "memory");
    case 0: break;
    }
}
#endif

#if defined(__AVR__)
#    include <util/delay.h>
#    define wait_ms(ms) _delay_ms(ms)
#    define wait_us(us) _delay_us(us)
#    define wait_cpuclock(x) __builtin_avr_delay_cycles(x)
#elif defined PROTOCOL_CHIBIOS
#    include <ch.h>
#    define wait_ms(ms)                     \
        do {                                \
            if (ms != 0) {                  \
                chThdSleepMilliseconds(ms); \
            } else {                        \
                chThdSleepMicroseconds(1);  \
            }                               \
        } while (0)
#    define wait_us(us)                     \
        do {                                \
            if (us != 0) {                  \
                chThdSleepMicroseconds(us); \
            } else {                        \
                chThdSleepMicroseconds(1);  \
            }                               \
        } while (0)
#elif defined PROTOCOL_ARM_ATSAM
#    include "clks.h"
#    define wait_ms(ms) CLK_delay_ms(ms)
#    define wait_us(us) CLK_delay_us(us)
#else  // Unit tests
void wait_ms(uint32_t ms);
#    define wait_us(us) wait_ms(us / 1000)
#endif

#ifdef __cplusplus
}
#endif