-
Notifications
You must be signed in to change notification settings - Fork 4
/
delay.h
51 lines (45 loc) · 1.72 KB
/
delay.h
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
/*
Licensed under the EUPL V.1.1, Lizenziert unter EUPL V.1.1
*/
/*******************************************************
File: Delay.h
Latest version generated: 02.06.2007
*******************************************************/
#ifndef _delay_h_
#define _delay_h_
#include <avr/io.h>
/* mth 9/04:
Remark uSeconds:
Main Oscillator Clock given by F_CPU (makefile) in Hz
one CPU-Cycle takes 1/F_CPU seconds => 1000000/F_OSC uSeconds
so: 1 uSecond takes F_CPU/1000000 CPU-Cyles. The following code
is inspired by the avr-libc delay_loop2 function.
This it not "that precise" since it takes at least 4 cycles
but should be o.k. with any parameter (even 0).
Call function with delayloop(DELAYUS(dt [in uSeconds])).
*/
/* delay function for microsec
4 cpu cycles per loop + 1 cycles(?) overhead
when a constant is passed. */
static inline void Delayloop16(uint16_t count)
{
asm volatile ( "cp %A0,__zero_reg__ \n\t" \
"cpc %B0,__zero_reg__ \n\t" \
"breq L_Exit_%= \n\t" \
"L_LOOP_%=: \n\t" \
"sbiw %0,1 \n\t" \
"brne L_LOOP_%= \n\t" \
"L_Exit_%=: \n\t" \
: "=w" (count)
: "0" (count)
);
}
// delayloop16(x) eats 4 cycles per x
#define DELAY_US_CONV(us) ((uint16_t)(((((us)*1000L)/(1000000000/F_CPU))-1)/4))
#define Delay_us(us) Delayloop16(DELAY_US_CONV(us))
/* delay function for millisec
(6 cycles per x + 20(?) overhead) */
void Delayloop32( uint32_t l); // not inline
#define DELAY_MS_CONV(ms) ( (uint32_t) (ms*(F_CPU/6000L)) )
#define Delay_ms(ms) Delayloop32(DELAY_MS_CONV(ms))
#endif