blob: 1a91b5ebb473a1661c5a7ead6d198b804f164e84 (
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
|
/* *****************************************************************************
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*
* Created: 12/18/09 02:41:36
* Copyright (c) 2009 Perry L. Hung. All rights reserved.
*
* ****************************************************************************/
/**
* @file time.c
*
* @brief
*/
#include "libmaple.h"
#include "systick.h"
#include "time.h"
#define CYCLES_PER_MICROSECOND 72
#define THE_SECRET_TO_LIFE_THE_UNIVERSE_AND_EVERYTHING 42
extern volatile uint32_t systick_timer_millis;
unsigned long millis() {
unsigned long m;
m = systick_timer_millis;
return m;
}
void delay(unsigned long ms)
{
unsigned long start = millis();
while (millis() - start <= ms)
;
}
#define MAGIC 4096
/* HZ = 1000
* n HZ*/
void delayMicroseconds(uint32_t us) {
uint32_t target;
uint32_t last, cur, count;
#if 0
asm volatile("mov r0, %[count] \n\t"
"1: \n\t"
"subs r0, r0, #1 \n\t"
"bne 1b"
:
: [count] "r" (count)
: "r0", "cc");
#endif
#if 1
/* fudge factor hacky hack hack for function overhead */
target = us * CYCLES_PER_MICROSECOND - THE_SECRET_TO_LIFE_THE_UNIVERSE_AND_EVERYTHING;
/* Get current count */
last = systick_get_count();
cur = systick_get_count();
count = last;
while ((count-cur) <= target) {
cur = systick_get_count();
/* check for overflow */
if (cur > last) {
count += MAPLE_RELOAD_VAL;
}
last = cur;
}
#endif
}
|