kal_timer_hrtimer.h

Go to the documentation of this file.

#ifndef KAL_TIMER_HRTIMER_H_
#define KAL_TIMER_HRTIMER_H_

#ifndef CONFIG_HIGH_RES_TIMERS
#  error "CONFIG_HIGH_RES_TIMERS not set in kernel config"
#endif

#include <linux/aquosa/qos_debug.h>
#include <linux/aquosa/qos_types.h>
#include <linux/aquosa/qos_memory.h>
#include <linux/hrtimer.h>

#include "kal_time.h"
#include "kal_arg.h"

typedef void (*kal_timer_cb)(kal_arg_t cb_data);

typedef struct kal_timer {
  struct hrtimer hrtimer;       //< The hrtimer instance
  kal_timer_cb timer_cb;        //< The KAL timer callback
  kal_arg_t timer_cb_data;      //< The opaque data to be supplied to the KAL timer callback
  char handler_running;         //< Whether we are within this timer handler
} kal_timer_t;

typedef enum hrtimer_restart (*hrtimer_cb)(struct hrtimer *);

static enum hrtimer_restart hrt_callback(struct hrtimer *hrt) {
  kal_timer_t * timer = (kal_timer_t *) hrt;
  qos_chk_do(qos_mem_valid(timer), goto out);
  timer->handler_running = 1;
  timer->timer_cb(timer->timer_cb_data);
  timer->handler_running = 0;
out:
  return HRTIMER_NORESTART;
}

static inline void kal_timer_init(kal_timer_t * p_timer, kal_timer_cb cb, kal_arg_t cb_data) {
//  printk("Initing timer %p with cb=%p and cb_data=%p\n", p_timer, cb, cb_data);
  hrtimer_init(&p_timer->hrtimer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
  p_timer->timer_cb = cb;
  p_timer->timer_cb_data = cb_data;
  p_timer->hrtimer.function = &hrt_callback;
  p_timer->handler_running = 0;
}

#if LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,28)
static inline void kal_timer_set_expires(kal_timer_t * p_timer, kal_time_t t) {
  hrtimer_set_expires((struct hrtimer*) p_timer, kal_time2ktime(t));
}
#else
static inline void kal_timer_set_expires(kal_timer_t * p_timer, kal_time_t t) {
  p_timer->hrtimer.expires = kal_time2ktime(t);
}
#endif

#if LINUX_VERSION_CODE>=KERNEL_VERSION(2,6,28)
static inline kal_time_t kal_timer_get_expires(kal_timer_t * p_timer) {
  return kal_ktime2time(hrtimer_get_expires((struct hrtimer*) p_timer));
}
#else
static inline kal_time_t kal_timer_get_expires(kal_timer_t * p_timer) {
  return kal_ktime2time(p_timer->hrtimer.expires);
}
#endif

static inline void kal_timer_init_now(kal_timer_t * p_timer, kal_timer_cb cb, kal_arg_t cb_data) {
  kal_time_t now = kal_time_now();
  kal_timer_init(p_timer, cb, cb_data);
  kal_timer_set_expires(p_timer, now);
}

static inline void kal_timer_del(kal_timer_t * p_timer) {
  if (hrtimer_active(&p_timer->hrtimer) && (! p_timer->handler_running)) {
//    printk("Deleting hrtimer %p (cb=%p, cb_data=%p)...\n", p_timer, p_timer->timer_cb, p_timer->timer_cb_data);
    hrtimer_cancel(&p_timer->hrtimer);
//    printk("...deleted hrtimer\n");
  }
}

static inline void kal_timer_set(kal_timer_t * p_timer, kal_time_t t) {
  kal_timer_del(p_timer);
  hrtimer_start(&p_timer->hrtimer, kal_time2ktime(t), HRTIMER_MODE_ABS);
}

static inline kal_time_t kal_timer_get_remaining(kal_timer_t * p_timer) {
  return kal_ktime2time(hrtimer_get_remaining(&p_timer->hrtimer));
}

static inline void kal_timer_forward(kal_timer_t * p_timer, kal_time_t t) {
  kal_time_t expires = kal_time_add(kal_timer_get_expires(p_timer), t);
  kal_timer_del(p_timer);
  hrtimer_start(&p_timer->hrtimer, kal_time2ktime(expires), HRTIMER_MODE_ABS);
}

static inline int kal_timer_pending(kal_timer_t *p_timer) {
  return hrtimer_active(&p_timer->hrtimer);
}

#endif /*KAL_TIMER_HRTIMER_H_*/

---