]> git.donarmstrong.com Git - kiibohd-controller.git/blob - Lib/delay.h
Code cleanup
[kiibohd-controller.git] / Lib / delay.h
1 /* Teensyduino Core Library
2  * http://www.pjrc.com/teensy/
3  * Copyright (c) 2013 PJRC.COM, LLC.
4  * Modifications by Jacob Alexander 2013-2015
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining
7  * a copy of this software and associated documentation files (the
8  * "Software"), to deal in the Software without restriction, including
9  * without limitation the rights to use, copy, modify, merge, publish,
10  * distribute, sublicense, and/or sell copies of the Software, and to
11  * permit persons to whom the Software is furnished to do so, subject to
12  * the following conditions:
13  *
14  * 1. The above copyright notice and this permission notice shall be
15  * included in all copies or substantial portions of the Software.
16  *
17  * 2. If the Software is incorporated into a build system that allows
18  * selection among a list of target devices, then similar target
19  * devices manufactured by PJRC.COM must be included in the list of
20  * target devices and selectable in the same manner.
21  *
22  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
23  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
24  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
25  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
26  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
27  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
28  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
29  * SOFTWARE.
30  */
31
32 #pragma once
33
34 // ----- System Includes -----
35
36 #include <stdint.h>
37
38
39
40 // ----- Macros -----
41
42 // Convenience Macros, for delay compatibility with AVR-GCC
43 #define _delay_ms(val) delay( val )
44 #define _delay_us(val) delayMicroseconds( val )
45
46
47
48 // ----- Functions -----
49
50 // the systick interrupt is supposed to increment this at 1 kHz rate
51 extern volatile uint32_t systick_millis_count;
52
53 static inline uint32_t millis(void) __attribute__((always_inline, unused));
54 static inline uint32_t millis(void)
55 {
56         return systick_millis_count; // single aligned 32 bit is atomic;
57 }
58
59
60 static inline void delayMicroseconds(uint32_t) __attribute__((always_inline, unused));
61 static inline void delayMicroseconds(uint32_t usec)
62 {
63 #if F_CPU == 96000000
64         uint32_t n = usec << 5;
65 #elif F_CPU == 72000000
66         uint32_t n = usec << 5; // XXX Not accurate, assembly snippet needs to be updated
67 #elif F_CPU == 48000000
68         uint32_t n = usec << 4;
69 #elif F_CPU == 24000000
70         uint32_t n = usec << 3;
71 #endif
72         asm volatile(
73                 "L_%=_delayMicroseconds:"               "\n\t"
74                 "subs   %0, #1"                         "\n\t"
75                 "bne    L_%=_delayMicroseconds"         "\n"
76                 : "+r" (n) :
77         );
78 }
79
80
81 void yield(void) __attribute__ ((weak));
82
83 uint32_t micros(void);
84
85 void delay(uint32_t ms);
86