Paparazzi UAS  v5.10_stable-5-g83a0da5-dirty
Paparazzi is a free software Unmanned Aircraft System.
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Modules Pages
sys_time_arch.h
Go to the documentation of this file.
1 /*
2  *
3  * Copyright (C) 2009-2011 The Paparazzi Team
4  *
5  * This file is part of paparazzi.
6  *
7  * paparazzi is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2, or (at your option)
10  * any later version.
11  *
12  * paparazzi is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15  * GNU General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with paparazzi; see the file COPYING. If not, write to
19  * the Free Software Foundation, 59 Temple Place - Suite 330,
20  * Boston, MA 02111-1307, USA.
21  *
22  */
23 
32 #ifndef SYS_TIME_ARCH_H
33 #define SYS_TIME_ARCH_H
34 
35 #include "mcu_periph/sys_time.h"
36 
37 #include <libopencm3/stm32/gpio.h>
38 #include <libopencm3/stm32/rcc.h>
39 #include <libopencm3/cm3/systick.h>
40 #include "std.h"
41 
47 static inline uint32_t get_sys_time_usec(void)
48 {
49  return sys_time.nb_sec * 1000000 +
51  usec_of_cpu_ticks(systick_get_reload() - systick_get_value());
52 }
53 
58 static inline uint32_t get_sys_time_msec(void)
59 {
60  return sys_time.nb_sec * 1000 +
62  msec_of_cpu_ticks(systick_get_reload() - systick_get_value());
63 }
64 
65 
71 static inline void sys_time_usleep(uint32_t us)
72 {
73  // start time
74  uint32_t start = systick_get_value();
75  // max time of one full counter cycle (n + 1 ticks)
76  uint32_t DT = usec_of_cpu_ticks(systick_get_reload() + 1);
77  // number of cycles
78  uint32_t n = us / DT;
79  // remaining number of cpu ticks
80  uint32_t rem = cpu_ticks_of_usec(us % DT);
81  // end time depend on the current value of the counter
82  uint32_t end;
83  if (rem < start) {
84  end = start - rem;
85  } else {
86  // one more count flag is required
87  n++;
88  end = systick_get_reload() - rem + start;
89  }
90  // count number of cycles (when counter reachs 0)
91  while (n) {
92  while (!systick_get_countflag());
93  n--;
94  }
95  // wait remaining ticks
96  while (systick_get_value() > end);
97 }
98 
99 #endif /* SYS_TIME_ARCH_H */
static uint32_t msec_of_cpu_ticks(uint32_t cpu_ticks)
Definition: sys_time.h:193
static uint32_t usec_of_cpu_ticks(uint32_t cpu_ticks)
Definition: sys_time.h:198
Architecture independent timing functions.
uint32_t get_sys_time_usec(void)
Get the time in microseconds since startup.
Definition: sys_time_arch.c:68
unsigned long uint32_t
Definition: types.h:18
volatile uint32_t nb_sec_rem
remainder of seconds since startup in CPU_TICKS
Definition: sys_time.h:73
void sys_time_usleep(uint32_t us)
sys_time_usleep(uint32_t us)
Definition: sys_time_arch.c:95
volatile uint32_t nb_sec
full seconds since startup
Definition: sys_time.h:72
uint32_t get_sys_time_msec(void)
Definition: sys_time_arch.c:78
static uint32_t cpu_ticks_of_usec(uint32_t usec)
Definition: sys_time.h:178