hw/ptimer.c

   1 /*
   2  * General purpose implementation of a simple periodic countdown timer.
   3  *
   4  * Copyright (c) 2007 CodeSourcery.
   5  *
   6  * This code is licenced under the GNU LGPL.
   7  */
   8 #include "hw.h"
   9 #include "qemu-timer.h"
  10
  11
  12 struct ptimer_state
  13 {
  14     int enabled; /* 0 = disabled, 1 = periodic, 2 = oneshot.  */
  15     uint64_t limit;
  16     uint64_t delta;
  17     uint32_t period_frac;
  18     int64_t period;
  19     int64_t last_event;
  20     int64_t next_event;
  21     QEMUBH *bh;
  22     QEMUTimer *timer;
  23 };
  24
  25 /* Use a bottom-half routine to avoid reentrancy issues.  */
  26 static void ptimer_trigger(ptimer_state *s)
  27 {
  28     if (s->bh) {
  29         qemu_bh_schedule(s->bh);
  30     }
  31 }
  32
  33 static void ptimer_reload(ptimer_state *s)
  34 {
  35     if (s->delta == 0) {
  36         ptimer_trigger(s);
  37         s->delta = s->limit;
  38     }
  39     if (s->delta == 0 || s->period == 0) {
  40         fprintf(stderr, "Timer with period zero, disabling\n");
  41         s->enabled = 0;
  42         return;
  43     }
  44
  45     s->last_event = s->next_event;
  46     s->next_event = s->last_event + s->delta * s->period;
  47     if (s->period_frac) {
  48         s->next_event += ((int64_t)s->period_frac * s->delta) >> 32;
  49     }
  50     qemu_mod_timer(s->timer, s->next_event);
  51 }
  52
  53 static void ptimer_tick(void *opaque)
  54 {
  55     ptimer_state *s = (ptimer_state *)opaque;
  56     ptimer_trigger(s);
  57     s->delta = 0;
  58     if (s->enabled == 2) {
  59         s->enabled = 0;
  60     } else {
  61         ptimer_reload(s);
  62     }
  63 }
  64
  65 uint64_t ptimer_get_count(ptimer_state *s)
  66 {
  67     int64_t now;
  68     uint64_t counter;
  69
  70     if (s->enabled) {
  71         now = qemu_get_clock(vm_clock);
  72         /* Figure out the current counter value.  */
  73         if (now - s->next_event > 0
  74             || s->period == 0) {
  75             /* Prevent timer underflowing if it should already have
  76                triggered.  */
  77             counter = 0;
  78         } else {
  79             uint64_t rem;
  80             uint64_t div;
  81
  82             rem = s->next_event - now;
  83             div = s->period;
  84             counter = rem / div;
  85         }
  86     } else {
  87         counter = s->delta;
  88     }
  89     return counter;
  90 }
  91
  92 void ptimer_set_count(ptimer_state *s, uint64_t count)
  93 {
  94     s->delta = count;
  95     if (s->enabled) {
  96         s->next_event = qemu_get_clock(vm_clock);
  97         ptimer_reload(s);
  98     }
  99 }
 100
 101 void ptimer_run(ptimer_state *s, int oneshot)
 102 {
 103     if (s->period == 0) {
 104         fprintf(stderr, "Timer with period zero, disabling\n");
 105         return;
 106     }
 107     s->enabled = oneshot ? 2 : 1;
 108     s->next_event = qemu_get_clock(vm_clock);
 109     ptimer_reload(s);
 110 }
 111
 112 /* Pause a timer.  Note that this may cause it to "lose" time, even if it
 113    is immediately restarted.  */
 114 void ptimer_stop(ptimer_state *s)
 115 {
 116     if (!s->enabled)
 117         return;
 118
 119     s->delta = ptimer_get_count(s);
 120     qemu_del_timer(s->timer);
 121     s->enabled = 0;
 122 }
 123
 124 /* Set counter increment interval in nanoseconds.  */
 125 void ptimer_set_period(ptimer_state *s, int64_t period)
 126 {
 127     s->period = period;
 128     s->period_frac = 0;
 129     if (s->enabled) {
 130         s->next_event = qemu_get_clock(vm_clock);
 131         ptimer_reload(s);
 132     }
 133 }
 134
 135 /* Set counter frequency in Hz.  */
 136 void ptimer_set_freq(ptimer_state *s, uint32_t freq)
 137 {
 138     s->period = 1000000000ll / freq;
 139     s->period_frac = (1000000000ll << 32) / freq;
 140     if (s->enabled) {
 141         s->next_event = qemu_get_clock(vm_clock);
 142         ptimer_reload(s);
 143     }
 144 }
 145
 146 /* Set the initial countdown value.  If reload is nonzero then also set
 147    count = limit.  */
 148 void ptimer_set_limit(ptimer_state *s, uint64_t limit, int reload)
 149 {
 150     s->limit = limit;
 151     if (reload)
 152         s->delta = limit;
 153     if (s->enabled && reload) {
 154         s->next_event = qemu_get_clock(vm_clock);
 155         ptimer_reload(s);
 156     }
 157 }
 158
 159 void qemu_put_ptimer(QEMUFile *f, ptimer_state *s)
 160 {
 161     qemu_put_byte(f, s->enabled);
 162     qemu_put_be64s(f, &s->limit);
 163     qemu_put_be64s(f, &s->delta);
 164     qemu_put_be32s(f, &s->period_frac);
 165     qemu_put_be64s(f, &s->period);
 166     qemu_put_be64s(f, &s->last_event);
 167     qemu_put_be64s(f, &s->next_event);
 168     qemu_put_timer(f, s->timer);
 169 }
 170
 171 void qemu_get_ptimer(QEMUFile *f, ptimer_state *s)
 172 {
 173     s->enabled = qemu_get_byte(f);
 174     qemu_get_be64s(f, &s->limit);
 175     qemu_get_be64s(f, &s->delta);
 176     qemu_get_be32s(f, &s->period_frac);
 177     qemu_get_be64s(f, &s->period);
 178     qemu_get_be64s(f, &s->last_event);
 179     qemu_get_be64s(f, &s->next_event);
 180     qemu_get_timer(f, s->timer);
 181 }
 182
 183 ptimer_state *ptimer_init(QEMUBH *bh)
 184 {
 185     ptimer_state *s;
 186
 187     s = (ptimer_state *)qemu_mallocz(sizeof(ptimer_state));
 188     s->bh = bh;
 189     s->timer = qemu_new_timer(vm_clock, ptimer_tick, s);
 190     return s;
 191 }
 192