kal_time_timespec.h

Go to the documentation of this file.

#ifndef KAL_TIME_TS_H_
#define KAL_TIME_TS_H_

#include <linux/time.h>
#ifdef QOS_KS
#  include <linux/ktime.h>
#endif

/********************** TIME RELATED **********************/

typedef struct timespec kal_time_t;

#define KAL_TIME_NS(sec, nsec) (struct timespec) { .tv_sec = (sec), .tv_nsec = ((long unsigned) nsec) }
#define KAL_TIME_US(sec, usec) (struct timespec) { .tv_sec = (sec), .tv_nsec = ((long unsigned) usec) * 1000 }

#define KAL_TIME_FMT "<%6lu.%06lu>"

#define KAL_TIME_FMT_ARG(t) kal_time_get_sec(t), kal_time_get_usec(t)

static inline kal_time_t kal_time_ns(unsigned long sec, unsigned long nsec) {
  struct timespec ts = { .tv_sec = (sec), .tv_nsec = (nsec) };
  return ts;
}

static inline signed long kal_time_get_sec(kal_time_t t) {
  return t.tv_sec;
}

static inline unsigned long kal_time_get_nsec(kal_time_t t) {
  return t.tv_nsec;
}

static inline unsigned long kal_time_get_usec(kal_time_t t) {
  return t.tv_nsec / 1000;
}

static inline unsigned long long kal_time2usec(kal_time_t t) {
  return t.tv_sec * 1000000ull + (unsigned long long) (t.tv_nsec / 1000);
}

static inline kal_time_t kal_usec2time(unsigned long long usec) {
  unsigned long us = (unsigned long) usec;
  kal_time_t t = KAL_TIME_US((unsigned long) (us / 1000000ul), (unsigned long) (us % 1000000ul));
  return t;
}

static inline kal_time_t kal_time_add(kal_time_t ta, kal_time_t tb) {
  struct timespec ts = {
    .tv_sec = ta.tv_sec + tb.tv_sec,
    .tv_nsec = ta.tv_nsec + tb.tv_nsec
  };
  if (unlikely(ts.tv_nsec >= 1000000000L)) {
    ts.tv_nsec -= 1000000000L;
    ts.tv_sec++;
  }
  return ts;
}

static inline kal_time_t kal_time_sub(kal_time_t ta, kal_time_t tb) {
  struct timespec ts = {
    .tv_sec = ta.tv_sec - tb.tv_sec,
    .tv_nsec = ta.tv_nsec - tb.tv_nsec
  };
  if (unlikely( ((signed long) ts.tv_nsec) < 0L )) {
    ts.tv_nsec += 1000000000L;
    ts.tv_sec--;
  }
  return ts;
}

static inline struct timespec kal_time2timespec(kal_time_t t) {
  return (struct timespec) t;
}

static inline int kal_time_lt(kal_time_t t1, kal_time_t t2) {
  return (((signed long) t1.tv_sec) < (signed long) t2.tv_sec)
    || (t1.tv_sec == t2.tv_sec && t1.tv_nsec < t2.tv_nsec);
}

static inline int kal_time_le(kal_time_t t1, kal_time_t t2) {
  return (((signed long) t1.tv_sec) < (signed long) t2.tv_sec)
    || (t1.tv_sec == t2.tv_sec && t1.tv_nsec <= t2.tv_nsec);
}

#ifdef QOS_KS

static inline kal_time_t kal_time_now(void) {
  struct timespec ts;
  ktime_get_ts(&ts);
//  printk("Read time: sec=%ld, nsec=%ld\n", ts.tv_sec, ts.tv_nsec);
  return ts;
}

#else /* !QOS_KS */

unsigned long get_simulation_time(void);

static inline unsigned long timespec_to_usec(const struct timespec *t) {
  return t->tv_sec * 1000000ull + (unsigned long long) (t->tv_nsec / 1000);
}

static inline void usec_to_timespec(const unsigned long usec, struct timespec *t) {
  *t = KAL_TIME_US((unsigned long) (usec / 1000000ul), (unsigned long) (usec % 1000000ul));
}

static inline kal_time_t kal_time_now(void) {
  return usec_to_timespec(get_simulation_time());
}

#endif /* QOS_KS */

#endif /*KAL_TIME_TS_H_*/

---