mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-29 03:36:07 +08:00
Inline ts_to_abstime and abstime_to_ts
Signed-off-by: Jukka Laitinen <jukkax@ssrc.tii.ae>
This commit is contained in:
committed by
Beat Küng
parent
3e6a35fe8a
commit
9f049b4dca
@@ -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
|
||||||
*/
|
*/
|
||||||
|
|||||||
@@ -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
|
||||||
*/
|
*/
|
||||||
|
|||||||
@@ -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
|
||||||
*/
|
*/
|
||||||
|
|||||||
@@ -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
|
||||||
*/
|
*/
|
||||||
|
|||||||
@@ -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
|
||||||
*/
|
*/
|
||||||
|
|||||||
@@ -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) {
|
||||||
|
|||||||
+15
-2
@@ -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
|
||||||
|
|||||||
Reference in New Issue
Block a user