Browse Source

Inline ts_to_abstime and abstime_to_ts

Signed-off-by: Jukka Laitinen <jukkax@ssrc.tii.ae>
master
Jukka Laitinen 3 years ago committed by Beat Küng
parent
commit
9f049b4dca
  1. 25
      platforms/nuttx/src/px4/nxp/imxrt/hrt/hrt.c
  2. 25
      platforms/nuttx/src/px4/nxp/kinetis/hrt/hrt.c
  3. 25
      platforms/nuttx/src/px4/nxp/s32k1xx/hrt/hrt.c
  4. 23
      platforms/nuttx/src/px4/rpi/rpi_common/hrt/hrt.c
  5. 25
      platforms/nuttx/src/px4/stm/stm32_common/hrt/hrt.c
  6. 20
      platforms/posix/src/px4/common/drv_hrt.cpp
  7. 17
      src/drivers/drv_hrt.h

25
platforms/nuttx/src/px4/nxp/imxrt/hrt/hrt.c

@ -561,31 +561,6 @@ hrt_absolute_time(void) @@ -561,31 +561,6 @@ hrt_absolute_time(void)
return abstime;
}
/**
* Convert a timespec to absolute time
*/
hrt_abstime
ts_to_abstime(const struct timespec *ts)
{
hrt_abstime result;
result = (hrt_abstime)(ts->tv_sec) * 1000000;
result += ts->tv_nsec / 1000;
return result;
}
/**
* Convert absolute time to a timespec.
*/
void
abstime_to_ts(struct timespec *ts, hrt_abstime abstime)
{
ts->tv_sec = abstime / 1000000;
abstime -= ts->tv_sec * 1000000;
ts->tv_nsec = abstime * 1000;
}
/**
* Store the absolute time in an interrupt-safe fashion
*/

25
platforms/nuttx/src/px4/nxp/kinetis/hrt/hrt.c

@ -573,31 +573,6 @@ hrt_absolute_time(void) @@ -573,31 +573,6 @@ hrt_absolute_time(void)
return abstime;
}
/**
* Convert a timespec to absolute time
*/
hrt_abstime
ts_to_abstime(const struct timespec *ts)
{
hrt_abstime result;
result = (hrt_abstime)(ts->tv_sec) * 1000000;
result += ts->tv_nsec / 1000;
return result;
}
/**
* Convert absolute time to a timespec.
*/
void
abstime_to_ts(struct timespec *ts, hrt_abstime abstime)
{
ts->tv_sec = abstime / 1000000;
abstime -= ts->tv_sec * 1000000;
ts->tv_nsec = abstime * 1000;
}
/**
* Store the absolute time in an interrupt-safe fashion
*/

25
platforms/nuttx/src/px4/nxp/s32k1xx/hrt/hrt.c

@ -609,31 +609,6 @@ hrt_absolute_time(void) @@ -609,31 +609,6 @@ hrt_absolute_time(void)
return abstime;
}
/**
* Convert a timespec to absolute time
*/
hrt_abstime
ts_to_abstime(const struct timespec *ts)
{
hrt_abstime result;
result = (hrt_abstime)(ts->tv_sec) * 1000000;
result += ts->tv_nsec / 1000;
return result;
}
/**
* Convert absolute time to a timespec.
*/
void
abstime_to_ts(struct timespec *ts, hrt_abstime abstime)
{
ts->tv_sec = abstime / 1000000;
abstime -= ts->tv_sec * 1000000;
ts->tv_nsec = abstime * 1000;
}
/**
* Store the absolute time in an interrupt-safe fashion
*/

23
platforms/nuttx/src/px4/rpi/rpi_common/hrt/hrt.c

@ -497,29 +497,6 @@ hrt_abstime hrt_absolute_time(void) @@ -497,29 +497,6 @@ hrt_abstime hrt_absolute_time(void)
return ((uint64_t) hi << 32) | lo;
}
/**
* Convert a timespec to absolute time
*/
hrt_abstime ts_to_abstime(const struct timespec *ts)
{
hrt_abstime result;
result = (hrt_abstime)(ts->tv_sec) * 1000000;
result += ts->tv_nsec / 1000;
return result;
}
/**
* Convert absolute time to a timespec.
*/
void abstime_to_ts(struct timespec *ts, hrt_abstime abstime)
{
ts->tv_sec = abstime / 1000000;
abstime -= ts->tv_sec * 1000000;
ts->tv_nsec = abstime * 1000;
}
/**
* Compare a time value with the current time as atomic operation
*/

25
platforms/nuttx/src/px4/stm/stm32_common/hrt/hrt.c

@ -694,31 +694,6 @@ hrt_absolute_time(void) @@ -694,31 +694,6 @@ hrt_absolute_time(void)
return abstime;
}
/**
* Convert a timespec to absolute time
*/
hrt_abstime
ts_to_abstime(const struct timespec *ts)
{
hrt_abstime result;
result = (hrt_abstime)(ts->tv_sec) * 1000000;
result += ts->tv_nsec / 1000;
return result;
}
/**
* Convert absolute time to a timespec.
*/
void
abstime_to_ts(struct timespec *ts, hrt_abstime abstime)
{
ts->tv_sec = abstime / 1000000;
abstime -= ts->tv_sec * 1000000;
ts->tv_nsec = abstime * 1000;
}
/**
* Store the absolute time in an interrupt-safe fashion
*/

20
platforms/posix/src/px4/common/drv_hrt.cpp

@ -144,19 +144,6 @@ hrt_abstime hrt_absolute_time() @@ -144,19 +144,6 @@ hrt_abstime hrt_absolute_time()
#endif // defined(ENABLE_LOCKSTEP_SCHEDULER)
}
/*
* Convert a timespec to absolute time.
*/
hrt_abstime ts_to_abstime(const struct timespec *ts)
{
hrt_abstime result;
result = (hrt_abstime)(ts->tv_sec) * 1000000;
result += ts->tv_nsec / 1000;
return result;
}
/*
* Store the absolute time in an interrupt-safe fashion.
*
@ -484,13 +471,6 @@ hrt_call_invoke() @@ -484,13 +471,6 @@ hrt_call_invoke()
hrt_unlock();
}
void abstime_to_ts(struct timespec *ts, hrt_abstime abstime)
{
ts->tv_sec = abstime / 1000000;
abstime -= ts->tv_sec * 1000000;
ts->tv_nsec = abstime * 1000;
}
int px4_clock_gettime(clockid_t clk_id, struct timespec *tp)
{
if (clk_id == CLOCK_MONOTONIC) {

17
src/drivers/drv_hrt.h

@ -97,12 +97,25 @@ __EXPORT extern hrt_abstime hrt_absolute_time(void); @@ -97,12 +97,25 @@ __EXPORT extern hrt_abstime hrt_absolute_time(void);
/**
* Convert a timespec to absolute time.
*/
__EXPORT extern hrt_abstime ts_to_abstime(const struct timespec *ts);
static inline hrt_abstime ts_to_abstime(const struct timespec *ts)
{
hrt_abstime result;
result = (hrt_abstime)(ts->tv_sec) * 1000000;
result += ts->tv_nsec / 1000;
return result;
}
/**
* Convert absolute time to a timespec.
*/
__EXPORT extern void abstime_to_ts(struct timespec *ts, hrt_abstime abstime);
static inline void abstime_to_ts(struct timespec *ts, hrt_abstime abstime)
{
ts->tv_sec = abstime / 1000000;
abstime -= ts->tv_sec * 1000000;
ts->tv_nsec = abstime * 1000;
}
/**
* Compute the delta between a timestamp taken in the past

Loading…
Cancel
Save