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)
return abstime; 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 * 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)
return abstime; 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 * 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)
return abstime; 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 * 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)
return ((uint64_t) hi << 32) | lo; 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 * 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)
return abstime; 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 * 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()
#endif // defined(ENABLE_LOCKSTEP_SCHEDULER) #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. * Store the absolute time in an interrupt-safe fashion.
* *
@ -484,13 +471,6 @@ hrt_call_invoke()
hrt_unlock(); 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) int px4_clock_gettime(clockid_t clk_id, struct timespec *tp)
{ {
if (clk_id == CLOCK_MONOTONIC) { if (clk_id == CLOCK_MONOTONIC) {

17
src/drivers/drv_hrt.h

@ -97,12 +97,25 @@ __EXPORT extern hrt_abstime hrt_absolute_time(void);
/** /**
* Convert a timespec to absolute time. * 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. * 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 * Compute the delta between a timestamp taken in the past

Loading…
Cancel
Save