blob: 4eda33d9008195226803042ccfb9d3ccdaa72df9 [file] [log] [blame]
aliguori16b29ae2008-12-17 23:28:44 +00001/*
2 * High Precisition Event Timer emulation
3 *
4 * Copyright (c) 2007 Alexander Graf
5 * Copyright (c) 2008 IBM Corporation
6 *
7 * Authors: Beth Kon <bkon@us.ibm.com>
8 *
9 * This library is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU Lesser General Public
11 * License as published by the Free Software Foundation; either
12 * version 2 of the License, or (at your option) any later version.
13 *
14 * This library is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 * Lesser General Public License for more details.
18 *
19 * You should have received a copy of the GNU Lesser General Public
Blue Swirl8167ee82009-07-16 20:47:01 +000020 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
aliguori16b29ae2008-12-17 23:28:44 +000021 *
22 * *****************************************************************
23 *
24 * This driver attempts to emulate an HPET device in software.
25 */
26
27#include "hw.h"
aurel32bf4f74c2008-12-18 22:42:34 +000028#include "pc.h"
aliguori16b29ae2008-12-17 23:28:44 +000029#include "console.h"
30#include "qemu-timer.h"
31#include "hpet_emul.h"
Jan Kiszka822557e2010-06-13 14:15:38 +020032#include "sysbus.h"
Jan Kiszka7d932df2010-06-13 14:15:40 +020033#include "mc146818rtc.h"
aliguori16b29ae2008-12-17 23:28:44 +000034
aliguori16b29ae2008-12-17 23:28:44 +000035//#define HPET_DEBUG
36#ifdef HPET_DEBUG
malcd0f2c4c2010-02-07 02:03:50 +030037#define DPRINTF printf
aliguori16b29ae2008-12-17 23:28:44 +000038#else
malcd0f2c4c2010-02-07 02:03:50 +030039#define DPRINTF(...)
aliguori16b29ae2008-12-17 23:28:44 +000040#endif
41
Jan Kiszka8caa0062010-06-13 14:15:45 +020042#define HPET_MSI_SUPPORT 0
43
Jan Kiszka27bb0b22010-06-13 14:15:35 +020044struct HPETState;
45typedef struct HPETTimer { /* timers */
46 uint8_t tn; /*timer number*/
47 QEMUTimer *qemu_timer;
48 struct HPETState *state;
49 /* Memory-mapped, software visible timer registers */
50 uint64_t config; /* configuration/cap */
51 uint64_t cmp; /* comparator */
Jan Kiszka8caa0062010-06-13 14:15:45 +020052 uint64_t fsb; /* FSB route */
Jan Kiszka27bb0b22010-06-13 14:15:35 +020053 /* Hidden register state */
54 uint64_t period; /* Last value written to comparator */
55 uint8_t wrap_flag; /* timer pop will indicate wrap for one-shot 32-bit
56 * mode. Next pop will be actual timer expiration.
57 */
58} HPETTimer;
59
60typedef struct HPETState {
Jan Kiszka822557e2010-06-13 14:15:38 +020061 SysBusDevice busdev;
Jan Kiszka27bb0b22010-06-13 14:15:35 +020062 uint64_t hpet_offset;
Jan Kiszka822557e2010-06-13 14:15:38 +020063 qemu_irq irqs[HPET_NUM_IRQ_ROUTES];
Jan Kiszka8caa0062010-06-13 14:15:45 +020064 uint32_t flags;
Jan Kiszka7d932df2010-06-13 14:15:40 +020065 uint8_t rtc_irq_level;
Jan Kiszkabe4b44c2010-06-13 14:15:44 +020066 uint8_t num_timers;
67 HPETTimer timer[HPET_MAX_TIMERS];
Jan Kiszka27bb0b22010-06-13 14:15:35 +020068
69 /* Memory-mapped, software visible registers */
70 uint64_t capability; /* capabilities */
71 uint64_t config; /* configuration */
72 uint64_t isr; /* interrupt status reg */
73 uint64_t hpet_counter; /* main counter */
Gleb Natapov40ac17c2010-06-14 11:29:28 +030074 uint8_t hpet_id; /* instance id */
Jan Kiszka27bb0b22010-06-13 14:15:35 +020075} HPETState;
76
Jan Kiszka7d932df2010-06-13 14:15:40 +020077static uint32_t hpet_in_legacy_mode(HPETState *s)
aliguori16b29ae2008-12-17 23:28:44 +000078{
Jan Kiszka7d932df2010-06-13 14:15:40 +020079 return s->config & HPET_CFG_LEGACY;
aliguori16b29ae2008-12-17 23:28:44 +000080}
81
aurel32c50c2d62008-12-18 22:42:43 +000082static uint32_t timer_int_route(struct HPETTimer *timer)
aliguori16b29ae2008-12-17 23:28:44 +000083{
Jan Kiszka27bb0b22010-06-13 14:15:35 +020084 return (timer->config & HPET_TN_INT_ROUTE_MASK) >> HPET_TN_INT_ROUTE_SHIFT;
aliguori16b29ae2008-12-17 23:28:44 +000085}
86
Jan Kiszka8caa0062010-06-13 14:15:45 +020087static uint32_t timer_fsb_route(HPETTimer *t)
88{
89 return t->config & HPET_TN_FSB_ENABLE;
90}
91
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +020092static uint32_t hpet_enabled(HPETState *s)
aliguori16b29ae2008-12-17 23:28:44 +000093{
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +020094 return s->config & HPET_CFG_ENABLE;
aliguori16b29ae2008-12-17 23:28:44 +000095}
96
97static uint32_t timer_is_periodic(HPETTimer *t)
98{
99 return t->config & HPET_TN_PERIODIC;
100}
101
102static uint32_t timer_enabled(HPETTimer *t)
103{
104 return t->config & HPET_TN_ENABLE;
105}
106
107static uint32_t hpet_time_after(uint64_t a, uint64_t b)
108{
109 return ((int32_t)(b) - (int32_t)(a) < 0);
110}
111
112static uint32_t hpet_time_after64(uint64_t a, uint64_t b)
113{
114 return ((int64_t)(b) - (int64_t)(a) < 0);
115}
116
aurel32c50c2d62008-12-18 22:42:43 +0000117static uint64_t ticks_to_ns(uint64_t value)
aliguori16b29ae2008-12-17 23:28:44 +0000118{
119 return (muldiv64(value, HPET_CLK_PERIOD, FS_PER_NS));
120}
121
aurel32c50c2d62008-12-18 22:42:43 +0000122static uint64_t ns_to_ticks(uint64_t value)
aliguori16b29ae2008-12-17 23:28:44 +0000123{
124 return (muldiv64(value, FS_PER_NS, HPET_CLK_PERIOD));
125}
126
127static uint64_t hpet_fixup_reg(uint64_t new, uint64_t old, uint64_t mask)
128{
129 new &= mask;
130 new |= old & ~mask;
131 return new;
132}
133
134static int activating_bit(uint64_t old, uint64_t new, uint64_t mask)
135{
aurel32c50c2d62008-12-18 22:42:43 +0000136 return (!(old & mask) && (new & mask));
aliguori16b29ae2008-12-17 23:28:44 +0000137}
138
139static int deactivating_bit(uint64_t old, uint64_t new, uint64_t mask)
140{
aurel32c50c2d62008-12-18 22:42:43 +0000141 return ((old & mask) && !(new & mask));
aliguori16b29ae2008-12-17 23:28:44 +0000142}
143
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200144static uint64_t hpet_get_ticks(HPETState *s)
aliguori16b29ae2008-12-17 23:28:44 +0000145{
Paolo Bonzini74475452011-03-11 16:47:48 +0100146 return ns_to_ticks(qemu_get_clock_ns(vm_clock) + s->hpet_offset);
aliguori16b29ae2008-12-17 23:28:44 +0000147}
148
aurel32c50c2d62008-12-18 22:42:43 +0000149/*
150 * calculate diff between comparator value and current ticks
aliguori16b29ae2008-12-17 23:28:44 +0000151 */
152static inline uint64_t hpet_calculate_diff(HPETTimer *t, uint64_t current)
153{
aurel32c50c2d62008-12-18 22:42:43 +0000154
aliguori16b29ae2008-12-17 23:28:44 +0000155 if (t->config & HPET_TN_32BIT) {
156 uint32_t diff, cmp;
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200157
aliguori16b29ae2008-12-17 23:28:44 +0000158 cmp = (uint32_t)t->cmp;
159 diff = cmp - (uint32_t)current;
160 diff = (int32_t)diff > 0 ? diff : (uint32_t)0;
161 return (uint64_t)diff;
162 } else {
163 uint64_t diff, cmp;
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200164
aliguori16b29ae2008-12-17 23:28:44 +0000165 cmp = t->cmp;
166 diff = cmp - current;
167 diff = (int64_t)diff > 0 ? diff : (uint64_t)0;
168 return diff;
169 }
170}
171
Jan Kiszka22a9fe32010-06-13 14:15:42 +0200172static void update_irq(struct HPETTimer *timer, int set)
aliguori16b29ae2008-12-17 23:28:44 +0000173{
Jan Kiszka22a9fe32010-06-13 14:15:42 +0200174 uint64_t mask;
175 HPETState *s;
aliguori16b29ae2008-12-17 23:28:44 +0000176 int route;
177
Jan Kiszka7d932df2010-06-13 14:15:40 +0200178 if (timer->tn <= 1 && hpet_in_legacy_mode(timer->state)) {
aliguori16b29ae2008-12-17 23:28:44 +0000179 /* if LegacyReplacementRoute bit is set, HPET specification requires
180 * timer0 be routed to IRQ0 in NON-APIC or IRQ2 in the I/O APIC,
aurel32c50c2d62008-12-18 22:42:43 +0000181 * timer1 be routed to IRQ8 in NON-APIC or IRQ8 in the I/O APIC.
aliguori16b29ae2008-12-17 23:28:44 +0000182 */
Jan Kiszka7d932df2010-06-13 14:15:40 +0200183 route = (timer->tn == 0) ? 0 : RTC_ISA_IRQ;
aliguori16b29ae2008-12-17 23:28:44 +0000184 } else {
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200185 route = timer_int_route(timer);
aliguori16b29ae2008-12-17 23:28:44 +0000186 }
Jan Kiszka22a9fe32010-06-13 14:15:42 +0200187 s = timer->state;
188 mask = 1 << timer->tn;
189 if (!set || !timer_enabled(timer) || !hpet_enabled(timer->state)) {
190 s->isr &= ~mask;
Jan Kiszka8caa0062010-06-13 14:15:45 +0200191 if (!timer_fsb_route(timer)) {
192 qemu_irq_lower(s->irqs[route]);
193 }
194 } else if (timer_fsb_route(timer)) {
Alexander Graf85172632011-07-05 18:28:03 +0200195 stl_le_phys(timer->fsb >> 32, timer->fsb & 0xffffffff);
Jan Kiszka22a9fe32010-06-13 14:15:42 +0200196 } else if (timer->config & HPET_TN_TYPE_LEVEL) {
197 s->isr |= mask;
198 qemu_irq_raise(s->irqs[route]);
199 } else {
200 s->isr &= ~mask;
201 qemu_irq_pulse(s->irqs[route]);
aliguori16b29ae2008-12-17 23:28:44 +0000202 }
203}
204
Juan Quintelad4bfa4d2009-09-29 22:48:22 +0200205static void hpet_pre_save(void *opaque)
aliguori16b29ae2008-12-17 23:28:44 +0000206{
Juan Quintelad4bfa4d2009-09-29 22:48:22 +0200207 HPETState *s = opaque;
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200208
aliguori16b29ae2008-12-17 23:28:44 +0000209 /* save current counter value */
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200210 s->hpet_counter = hpet_get_ticks(s);
aliguori16b29ae2008-12-17 23:28:44 +0000211}
212
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200213static int hpet_pre_load(void *opaque)
214{
215 HPETState *s = opaque;
216
217 /* version 1 only supports 3, later versions will load the actual value */
218 s->num_timers = HPET_MIN_TIMERS;
219 return 0;
220}
221
Juan Quintelae59fb372009-09-29 22:48:21 +0200222static int hpet_post_load(void *opaque, int version_id)
aliguori16b29ae2008-12-17 23:28:44 +0000223{
224 HPETState *s = opaque;
aurel32c50c2d62008-12-18 22:42:43 +0000225
aliguori16b29ae2008-12-17 23:28:44 +0000226 /* Recalculate the offset between the main counter and guest time */
Paolo Bonzini74475452011-03-11 16:47:48 +0100227 s->hpet_offset = ticks_to_ns(s->hpet_counter) - qemu_get_clock_ns(vm_clock);
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200228
229 /* Push number of timers into capability returned via HPET_ID */
230 s->capability &= ~HPET_ID_NUM_TIM_MASK;
231 s->capability |= (s->num_timers - 1) << HPET_ID_NUM_TIM_SHIFT;
Gleb Natapov40ac17c2010-06-14 11:29:28 +0300232 hpet_cfg.hpet[s->hpet_id].event_timer_block_id = (uint32_t)s->capability;
Jan Kiszka8caa0062010-06-13 14:15:45 +0200233
234 /* Derive HPET_MSI_SUPPORT from the capability of the first timer. */
235 s->flags &= ~(1 << HPET_MSI_SUPPORT);
236 if (s->timer[0].config & HPET_TN_FSB_CAP) {
237 s->flags |= 1 << HPET_MSI_SUPPORT;
238 }
aliguori16b29ae2008-12-17 23:28:44 +0000239 return 0;
240}
241
Juan Quintelae6cb4d42009-09-10 03:04:45 +0200242static const VMStateDescription vmstate_hpet_timer = {
243 .name = "hpet_timer",
244 .version_id = 1,
245 .minimum_version_id = 1,
246 .minimum_version_id_old = 1,
247 .fields = (VMStateField []) {
248 VMSTATE_UINT8(tn, HPETTimer),
249 VMSTATE_UINT64(config, HPETTimer),
250 VMSTATE_UINT64(cmp, HPETTimer),
251 VMSTATE_UINT64(fsb, HPETTimer),
252 VMSTATE_UINT64(period, HPETTimer),
253 VMSTATE_UINT8(wrap_flag, HPETTimer),
254 VMSTATE_TIMER(qemu_timer, HPETTimer),
255 VMSTATE_END_OF_LIST()
256 }
257};
258
259static const VMStateDescription vmstate_hpet = {
260 .name = "hpet",
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200261 .version_id = 2,
Juan Quintelae6cb4d42009-09-10 03:04:45 +0200262 .minimum_version_id = 1,
263 .minimum_version_id_old = 1,
264 .pre_save = hpet_pre_save,
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200265 .pre_load = hpet_pre_load,
Juan Quintelae6cb4d42009-09-10 03:04:45 +0200266 .post_load = hpet_post_load,
267 .fields = (VMStateField []) {
268 VMSTATE_UINT64(config, HPETState),
269 VMSTATE_UINT64(isr, HPETState),
270 VMSTATE_UINT64(hpet_counter, HPETState),
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200271 VMSTATE_UINT8_V(num_timers, HPETState, 2),
272 VMSTATE_STRUCT_VARRAY_UINT8(timer, HPETState, num_timers, 0,
273 vmstate_hpet_timer, HPETTimer),
Juan Quintelae6cb4d42009-09-10 03:04:45 +0200274 VMSTATE_END_OF_LIST()
275 }
276};
277
aurel32c50c2d62008-12-18 22:42:43 +0000278/*
aliguori16b29ae2008-12-17 23:28:44 +0000279 * timer expiration callback
280 */
281static void hpet_timer(void *opaque)
282{
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200283 HPETTimer *t = opaque;
aliguori16b29ae2008-12-17 23:28:44 +0000284 uint64_t diff;
285
286 uint64_t period = t->period;
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200287 uint64_t cur_tick = hpet_get_ticks(t->state);
aliguori16b29ae2008-12-17 23:28:44 +0000288
289 if (timer_is_periodic(t) && period != 0) {
290 if (t->config & HPET_TN_32BIT) {
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200291 while (hpet_time_after(cur_tick, t->cmp)) {
aliguori16b29ae2008-12-17 23:28:44 +0000292 t->cmp = (uint32_t)(t->cmp + t->period);
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200293 }
294 } else {
295 while (hpet_time_after64(cur_tick, t->cmp)) {
aliguori16b29ae2008-12-17 23:28:44 +0000296 t->cmp += period;
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200297 }
298 }
aliguori16b29ae2008-12-17 23:28:44 +0000299 diff = hpet_calculate_diff(t, cur_tick);
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200300 qemu_mod_timer(t->qemu_timer,
Paolo Bonzini74475452011-03-11 16:47:48 +0100301 qemu_get_clock_ns(vm_clock) + (int64_t)ticks_to_ns(diff));
aliguori16b29ae2008-12-17 23:28:44 +0000302 } else if (t->config & HPET_TN_32BIT && !timer_is_periodic(t)) {
303 if (t->wrap_flag) {
304 diff = hpet_calculate_diff(t, cur_tick);
Paolo Bonzini74475452011-03-11 16:47:48 +0100305 qemu_mod_timer(t->qemu_timer, qemu_get_clock_ns(vm_clock) +
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200306 (int64_t)ticks_to_ns(diff));
aliguori16b29ae2008-12-17 23:28:44 +0000307 t->wrap_flag = 0;
308 }
309 }
Jan Kiszka22a9fe32010-06-13 14:15:42 +0200310 update_irq(t, 1);
aliguori16b29ae2008-12-17 23:28:44 +0000311}
312
313static void hpet_set_timer(HPETTimer *t)
314{
315 uint64_t diff;
316 uint32_t wrap_diff; /* how many ticks until we wrap? */
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200317 uint64_t cur_tick = hpet_get_ticks(t->state);
aurel32c50c2d62008-12-18 22:42:43 +0000318
aliguori16b29ae2008-12-17 23:28:44 +0000319 /* whenever new timer is being set up, make sure wrap_flag is 0 */
320 t->wrap_flag = 0;
321 diff = hpet_calculate_diff(t, cur_tick);
322
aurel32c50c2d62008-12-18 22:42:43 +0000323 /* hpet spec says in one-shot 32-bit mode, generate an interrupt when
aliguori16b29ae2008-12-17 23:28:44 +0000324 * counter wraps in addition to an interrupt with comparator match.
aurel32c50c2d62008-12-18 22:42:43 +0000325 */
aliguori16b29ae2008-12-17 23:28:44 +0000326 if (t->config & HPET_TN_32BIT && !timer_is_periodic(t)) {
327 wrap_diff = 0xffffffff - (uint32_t)cur_tick;
328 if (wrap_diff < (uint32_t)diff) {
329 diff = wrap_diff;
aurel32c50c2d62008-12-18 22:42:43 +0000330 t->wrap_flag = 1;
aliguori16b29ae2008-12-17 23:28:44 +0000331 }
332 }
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200333 qemu_mod_timer(t->qemu_timer,
Paolo Bonzini74475452011-03-11 16:47:48 +0100334 qemu_get_clock_ns(vm_clock) + (int64_t)ticks_to_ns(diff));
aliguori16b29ae2008-12-17 23:28:44 +0000335}
336
337static void hpet_del_timer(HPETTimer *t)
338{
339 qemu_del_timer(t->qemu_timer);
Jan Kiszka22a9fe32010-06-13 14:15:42 +0200340 update_irq(t, 0);
aliguori16b29ae2008-12-17 23:28:44 +0000341}
342
343#ifdef HPET_DEBUG
Anthony Liguoric227f092009-10-01 16:12:16 -0500344static uint32_t hpet_ram_readb(void *opaque, target_phys_addr_t addr)
aliguori16b29ae2008-12-17 23:28:44 +0000345{
346 printf("qemu: hpet_read b at %" PRIx64 "\n", addr);
347 return 0;
348}
349
Anthony Liguoric227f092009-10-01 16:12:16 -0500350static uint32_t hpet_ram_readw(void *opaque, target_phys_addr_t addr)
aliguori16b29ae2008-12-17 23:28:44 +0000351{
352 printf("qemu: hpet_read w at %" PRIx64 "\n", addr);
353 return 0;
354}
355#endif
356
Anthony Liguoric227f092009-10-01 16:12:16 -0500357static uint32_t hpet_ram_readl(void *opaque, target_phys_addr_t addr)
aliguori16b29ae2008-12-17 23:28:44 +0000358{
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200359 HPETState *s = opaque;
aliguori16b29ae2008-12-17 23:28:44 +0000360 uint64_t cur_tick, index;
361
malcd0f2c4c2010-02-07 02:03:50 +0300362 DPRINTF("qemu: Enter hpet_ram_readl at %" PRIx64 "\n", addr);
aliguori16b29ae2008-12-17 23:28:44 +0000363 index = addr;
364 /*address range of all TN regs*/
365 if (index >= 0x100 && index <= 0x3ff) {
366 uint8_t timer_id = (addr - 0x100) / 0x20;
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200367 HPETTimer *timer = &s->timer[timer_id];
368
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200369 if (timer_id > s->num_timers) {
Jan Kiszka6982d662010-06-13 14:15:34 +0200370 DPRINTF("qemu: timer id out of range\n");
aliguori16b29ae2008-12-17 23:28:44 +0000371 return 0;
372 }
aliguori16b29ae2008-12-17 23:28:44 +0000373
374 switch ((addr - 0x100) % 0x20) {
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200375 case HPET_TN_CFG:
376 return timer->config;
377 case HPET_TN_CFG + 4: // Interrupt capabilities
378 return timer->config >> 32;
379 case HPET_TN_CMP: // comparator register
380 return timer->cmp;
381 case HPET_TN_CMP + 4:
382 return timer->cmp >> 32;
383 case HPET_TN_ROUTE:
Jan Kiszka8caa0062010-06-13 14:15:45 +0200384 return timer->fsb;
385 case HPET_TN_ROUTE + 4:
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200386 return timer->fsb >> 32;
387 default:
388 DPRINTF("qemu: invalid hpet_ram_readl\n");
389 break;
aliguori16b29ae2008-12-17 23:28:44 +0000390 }
391 } else {
392 switch (index) {
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200393 case HPET_ID:
394 return s->capability;
395 case HPET_PERIOD:
396 return s->capability >> 32;
397 case HPET_CFG:
398 return s->config;
399 case HPET_CFG + 4:
400 DPRINTF("qemu: invalid HPET_CFG + 4 hpet_ram_readl \n");
401 return 0;
402 case HPET_COUNTER:
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200403 if (hpet_enabled(s)) {
404 cur_tick = hpet_get_ticks(s);
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200405 } else {
406 cur_tick = s->hpet_counter;
407 }
408 DPRINTF("qemu: reading counter = %" PRIx64 "\n", cur_tick);
409 return cur_tick;
410 case HPET_COUNTER + 4:
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200411 if (hpet_enabled(s)) {
412 cur_tick = hpet_get_ticks(s);
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200413 } else {
414 cur_tick = s->hpet_counter;
415 }
416 DPRINTF("qemu: reading counter + 4 = %" PRIx64 "\n", cur_tick);
417 return cur_tick >> 32;
418 case HPET_STATUS:
419 return s->isr;
420 default:
421 DPRINTF("qemu: invalid hpet_ram_readl\n");
422 break;
aliguori16b29ae2008-12-17 23:28:44 +0000423 }
424 }
425 return 0;
426}
427
428#ifdef HPET_DEBUG
Anthony Liguoric227f092009-10-01 16:12:16 -0500429static void hpet_ram_writeb(void *opaque, target_phys_addr_t addr,
aliguori16b29ae2008-12-17 23:28:44 +0000430 uint32_t value)
431{
aurel32c50c2d62008-12-18 22:42:43 +0000432 printf("qemu: invalid hpet_write b at %" PRIx64 " = %#x\n",
aliguori16b29ae2008-12-17 23:28:44 +0000433 addr, value);
434}
435
Anthony Liguoric227f092009-10-01 16:12:16 -0500436static void hpet_ram_writew(void *opaque, target_phys_addr_t addr,
aliguori16b29ae2008-12-17 23:28:44 +0000437 uint32_t value)
438{
aurel32c50c2d62008-12-18 22:42:43 +0000439 printf("qemu: invalid hpet_write w at %" PRIx64 " = %#x\n",
aliguori16b29ae2008-12-17 23:28:44 +0000440 addr, value);
441}
442#endif
443
Anthony Liguoric227f092009-10-01 16:12:16 -0500444static void hpet_ram_writel(void *opaque, target_phys_addr_t addr,
aliguori16b29ae2008-12-17 23:28:44 +0000445 uint32_t value)
446{
447 int i;
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200448 HPETState *s = opaque;
Beth Konce536cf2009-07-24 12:26:59 -0400449 uint64_t old_val, new_val, val, index;
aliguori16b29ae2008-12-17 23:28:44 +0000450
malcd0f2c4c2010-02-07 02:03:50 +0300451 DPRINTF("qemu: Enter hpet_ram_writel at %" PRIx64 " = %#x\n", addr, value);
aliguori16b29ae2008-12-17 23:28:44 +0000452 index = addr;
453 old_val = hpet_ram_readl(opaque, addr);
454 new_val = value;
455
456 /*address range of all TN regs*/
457 if (index >= 0x100 && index <= 0x3ff) {
458 uint8_t timer_id = (addr - 0x100) / 0x20;
aliguori16b29ae2008-12-17 23:28:44 +0000459 HPETTimer *timer = &s->timer[timer_id];
aurel32c50c2d62008-12-18 22:42:43 +0000460
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200461 DPRINTF("qemu: hpet_ram_writel timer_id = %#x \n", timer_id);
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200462 if (timer_id > s->num_timers) {
Jan Kiszka6982d662010-06-13 14:15:34 +0200463 DPRINTF("qemu: timer id out of range\n");
464 return;
465 }
aliguori16b29ae2008-12-17 23:28:44 +0000466 switch ((addr - 0x100) % 0x20) {
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200467 case HPET_TN_CFG:
468 DPRINTF("qemu: hpet_ram_writel HPET_TN_CFG\n");
Jan Kiszka8caa0062010-06-13 14:15:45 +0200469 if (activating_bit(old_val, new_val, HPET_TN_FSB_ENABLE)) {
470 update_irq(timer, 0);
471 }
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200472 val = hpet_fixup_reg(new_val, old_val, HPET_TN_CFG_WRITE_MASK);
473 timer->config = (timer->config & 0xffffffff00000000ULL) | val;
474 if (new_val & HPET_TN_32BIT) {
475 timer->cmp = (uint32_t)timer->cmp;
476 timer->period = (uint32_t)timer->period;
477 }
Jan Kiszka9cec89e2010-06-13 14:15:39 +0200478 if (activating_bit(old_val, new_val, HPET_TN_ENABLE)) {
479 hpet_set_timer(timer);
480 } else if (deactivating_bit(old_val, new_val, HPET_TN_ENABLE)) {
481 hpet_del_timer(timer);
482 }
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200483 break;
484 case HPET_TN_CFG + 4: // Interrupt capabilities
485 DPRINTF("qemu: invalid HPET_TN_CFG+4 write\n");
486 break;
487 case HPET_TN_CMP: // comparator register
488 DPRINTF("qemu: hpet_ram_writel HPET_TN_CMP \n");
489 if (timer->config & HPET_TN_32BIT) {
490 new_val = (uint32_t)new_val;
491 }
492 if (!timer_is_periodic(timer)
493 || (timer->config & HPET_TN_SETVAL)) {
494 timer->cmp = (timer->cmp & 0xffffffff00000000ULL) | new_val;
495 }
496 if (timer_is_periodic(timer)) {
497 /*
498 * FIXME: Clamp period to reasonable min value?
499 * Clamp period to reasonable max value
500 */
501 new_val &= (timer->config & HPET_TN_32BIT ? ~0u : ~0ull) >> 1;
502 timer->period =
503 (timer->period & 0xffffffff00000000ULL) | new_val;
504 }
505 timer->config &= ~HPET_TN_SETVAL;
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200506 if (hpet_enabled(s)) {
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200507 hpet_set_timer(timer);
508 }
509 break;
510 case HPET_TN_CMP + 4: // comparator register high order
511 DPRINTF("qemu: hpet_ram_writel HPET_TN_CMP + 4\n");
512 if (!timer_is_periodic(timer)
513 || (timer->config & HPET_TN_SETVAL)) {
514 timer->cmp = (timer->cmp & 0xffffffffULL) | new_val << 32;
515 } else {
516 /*
517 * FIXME: Clamp period to reasonable min value?
518 * Clamp period to reasonable max value
519 */
520 new_val &= (timer->config & HPET_TN_32BIT ? ~0u : ~0ull) >> 1;
521 timer->period =
522 (timer->period & 0xffffffffULL) | new_val << 32;
aliguori16b29ae2008-12-17 23:28:44 +0000523 }
524 timer->config &= ~HPET_TN_SETVAL;
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200525 if (hpet_enabled(s)) {
aliguori16b29ae2008-12-17 23:28:44 +0000526 hpet_set_timer(timer);
aliguori16b29ae2008-12-17 23:28:44 +0000527 }
aliguori16b29ae2008-12-17 23:28:44 +0000528 break;
Jan Kiszka8caa0062010-06-13 14:15:45 +0200529 case HPET_TN_ROUTE:
530 timer->fsb = (timer->fsb & 0xffffffff00000000ULL) | new_val;
531 break;
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200532 case HPET_TN_ROUTE + 4:
Jan Kiszka8caa0062010-06-13 14:15:45 +0200533 timer->fsb = (new_val << 32) | (timer->fsb & 0xffffffff);
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200534 break;
535 default:
536 DPRINTF("qemu: invalid hpet_ram_writel\n");
537 break;
aliguori16b29ae2008-12-17 23:28:44 +0000538 }
539 return;
540 } else {
541 switch (index) {
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200542 case HPET_ID:
543 return;
544 case HPET_CFG:
545 val = hpet_fixup_reg(new_val, old_val, HPET_CFG_WRITE_MASK);
546 s->config = (s->config & 0xffffffff00000000ULL) | val;
547 if (activating_bit(old_val, new_val, HPET_CFG_ENABLE)) {
548 /* Enable main counter and interrupt generation. */
549 s->hpet_offset =
Paolo Bonzini74475452011-03-11 16:47:48 +0100550 ticks_to_ns(s->hpet_counter) - qemu_get_clock_ns(vm_clock);
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200551 for (i = 0; i < s->num_timers; i++) {
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200552 if ((&s->timer[i])->cmp != ~0ULL) {
553 hpet_set_timer(&s->timer[i]);
554 }
aliguori16b29ae2008-12-17 23:28:44 +0000555 }
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200556 } else if (deactivating_bit(old_val, new_val, HPET_CFG_ENABLE)) {
557 /* Halt main counter and disable interrupt generation. */
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200558 s->hpet_counter = hpet_get_ticks(s);
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200559 for (i = 0; i < s->num_timers; i++) {
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200560 hpet_del_timer(&s->timer[i]);
aliguori16b29ae2008-12-17 23:28:44 +0000561 }
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200562 }
563 /* i8254 and RTC are disabled when HPET is in legacy mode */
564 if (activating_bit(old_val, new_val, HPET_CFG_LEGACY)) {
565 hpet_pit_disable();
Jan Kiszka7d932df2010-06-13 14:15:40 +0200566 qemu_irq_lower(s->irqs[RTC_ISA_IRQ]);
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200567 } else if (deactivating_bit(old_val, new_val, HPET_CFG_LEGACY)) {
568 hpet_pit_enable();
Jan Kiszka7d932df2010-06-13 14:15:40 +0200569 qemu_set_irq(s->irqs[RTC_ISA_IRQ], s->rtc_irq_level);
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200570 }
571 break;
572 case HPET_CFG + 4:
573 DPRINTF("qemu: invalid HPET_CFG+4 write \n");
574 break;
575 case HPET_STATUS:
Jan Kiszka22a9fe32010-06-13 14:15:42 +0200576 val = new_val & s->isr;
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200577 for (i = 0; i < s->num_timers; i++) {
Jan Kiszka22a9fe32010-06-13 14:15:42 +0200578 if (val & (1 << i)) {
579 update_irq(&s->timer[i], 0);
580 }
581 }
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200582 break;
583 case HPET_COUNTER:
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200584 if (hpet_enabled(s)) {
Jan Kiszkaad0a6552010-06-13 14:15:36 +0200585 DPRINTF("qemu: Writing counter while HPET enabled!\n");
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200586 }
587 s->hpet_counter =
588 (s->hpet_counter & 0xffffffff00000000ULL) | value;
589 DPRINTF("qemu: HPET counter written. ctr = %#x -> %" PRIx64 "\n",
590 value, s->hpet_counter);
591 break;
592 case HPET_COUNTER + 4:
Jan Kiszkab7eaa6c2010-06-13 14:15:41 +0200593 if (hpet_enabled(s)) {
Jan Kiszkaad0a6552010-06-13 14:15:36 +0200594 DPRINTF("qemu: Writing counter while HPET enabled!\n");
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200595 }
596 s->hpet_counter =
597 (s->hpet_counter & 0xffffffffULL) | (((uint64_t)value) << 32);
598 DPRINTF("qemu: HPET counter + 4 written. ctr = %#x -> %" PRIx64 "\n",
599 value, s->hpet_counter);
600 break;
601 default:
602 DPRINTF("qemu: invalid hpet_ram_writel\n");
603 break;
aliguori16b29ae2008-12-17 23:28:44 +0000604 }
605 }
606}
607
Blue Swirld60efc62009-08-25 18:29:31 +0000608static CPUReadMemoryFunc * const hpet_ram_read[] = {
aliguori16b29ae2008-12-17 23:28:44 +0000609#ifdef HPET_DEBUG
610 hpet_ram_readb,
611 hpet_ram_readw,
612#else
613 NULL,
614 NULL,
615#endif
616 hpet_ram_readl,
617};
618
Blue Swirld60efc62009-08-25 18:29:31 +0000619static CPUWriteMemoryFunc * const hpet_ram_write[] = {
aliguori16b29ae2008-12-17 23:28:44 +0000620#ifdef HPET_DEBUG
621 hpet_ram_writeb,
622 hpet_ram_writew,
623#else
624 NULL,
625 NULL,
626#endif
627 hpet_ram_writel,
628};
629
Jan Kiszka822557e2010-06-13 14:15:38 +0200630static void hpet_reset(DeviceState *d)
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200631{
Jan Kiszka822557e2010-06-13 14:15:38 +0200632 HPETState *s = FROM_SYSBUS(HPETState, sysbus_from_qdev(d));
aliguori16b29ae2008-12-17 23:28:44 +0000633 int i;
634 static int count = 0;
635
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200636 for (i = 0; i < s->num_timers; i++) {
aliguori16b29ae2008-12-17 23:28:44 +0000637 HPETTimer *timer = &s->timer[i];
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200638
aliguori16b29ae2008-12-17 23:28:44 +0000639 hpet_del_timer(timer);
aliguori16b29ae2008-12-17 23:28:44 +0000640 timer->cmp = ~0ULL;
Jan Kiszka8caa0062010-06-13 14:15:45 +0200641 timer->config = HPET_TN_PERIODIC_CAP | HPET_TN_SIZE_CAP;
642 if (s->flags & (1 << HPET_MSI_SUPPORT)) {
643 timer->config |= HPET_TN_FSB_CAP;
644 }
Beth Konce536cf2009-07-24 12:26:59 -0400645 /* advertise availability of ioapic inti2 */
646 timer->config |= 0x00000004ULL << 32;
aliguori16b29ae2008-12-17 23:28:44 +0000647 timer->period = 0ULL;
648 timer->wrap_flag = 0;
649 }
650
651 s->hpet_counter = 0ULL;
652 s->hpet_offset = 0ULL;
Beth Kon7d93b1f2009-07-13 19:43:13 -0400653 s->config = 0ULL;
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200654 if (count > 0) {
aurel32c50c2d62008-12-18 22:42:43 +0000655 /* we don't enable pit when hpet_reset is first called (by hpet_init)
aliguori16b29ae2008-12-17 23:28:44 +0000656 * because hpet is taking over for pit here. On subsequent invocations,
657 * hpet_reset is called due to system reset. At this point control must
aurel32c50c2d62008-12-18 22:42:43 +0000658 * be returned to pit until SW reenables hpet.
aliguori16b29ae2008-12-17 23:28:44 +0000659 */
660 hpet_pit_enable();
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200661 }
Gleb Natapov40ac17c2010-06-14 11:29:28 +0300662 hpet_cfg.hpet[s->hpet_id].event_timer_block_id = (uint32_t)s->capability;
663 hpet_cfg.hpet[s->hpet_id].address = sysbus_from_qdev(d)->mmio[0].addr;
aliguori16b29ae2008-12-17 23:28:44 +0000664 count = 1;
665}
666
Jan Kiszka7d932df2010-06-13 14:15:40 +0200667static void hpet_handle_rtc_irq(void *opaque, int n, int level)
668{
669 HPETState *s = FROM_SYSBUS(HPETState, opaque);
670
671 s->rtc_irq_level = level;
672 if (!hpet_in_legacy_mode(s)) {
673 qemu_set_irq(s->irqs[RTC_ISA_IRQ], level);
674 }
675}
676
Jan Kiszka822557e2010-06-13 14:15:38 +0200677static int hpet_init(SysBusDevice *dev)
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200678{
Jan Kiszka822557e2010-06-13 14:15:38 +0200679 HPETState *s = FROM_SYSBUS(HPETState, dev);
aliguori16b29ae2008-12-17 23:28:44 +0000680 int i, iomemtype;
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200681 HPETTimer *timer;
aurel32c50c2d62008-12-18 22:42:43 +0000682
Stefan Weild2c5efd2010-06-15 23:03:28 +0200683 if (hpet_cfg.count == UINT8_MAX) {
684 /* first instance */
Gleb Natapov40ac17c2010-06-14 11:29:28 +0300685 hpet_cfg.count = 0;
Stefan Weild2c5efd2010-06-15 23:03:28 +0200686 }
Gleb Natapov40ac17c2010-06-14 11:29:28 +0300687
688 if (hpet_cfg.count == 8) {
689 fprintf(stderr, "Only 8 instances of HPET is allowed\n");
690 return -1;
691 }
692
693 s->hpet_id = hpet_cfg.count++;
694
Jan Kiszka822557e2010-06-13 14:15:38 +0200695 for (i = 0; i < HPET_NUM_IRQ_ROUTES; i++) {
696 sysbus_init_irq(dev, &s->irqs[i]);
697 }
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200698
699 if (s->num_timers < HPET_MIN_TIMERS) {
700 s->num_timers = HPET_MIN_TIMERS;
701 } else if (s->num_timers > HPET_MAX_TIMERS) {
702 s->num_timers = HPET_MAX_TIMERS;
703 }
704 for (i = 0; i < HPET_MAX_TIMERS; i++) {
Jan Kiszka27bb0b22010-06-13 14:15:35 +0200705 timer = &s->timer[i];
Paolo Bonzini74475452011-03-11 16:47:48 +0100706 timer->qemu_timer = qemu_new_timer_ns(vm_clock, hpet_timer, timer);
Jan Kiszka7afbecc2010-06-13 14:15:37 +0200707 timer->tn = i;
708 timer->state = s;
aliguori16b29ae2008-12-17 23:28:44 +0000709 }
Jan Kiszka822557e2010-06-13 14:15:38 +0200710
Jan Kiszka072c2c32010-06-14 08:40:29 +0200711 /* 64-bit main counter; LegacyReplacementRoute. */
712 s->capability = 0x8086a001ULL;
713 s->capability |= (s->num_timers - 1) << HPET_ID_NUM_TIM_SHIFT;
714 s->capability |= ((HPET_CLK_PERIOD) << 32);
715
Jan Kiszka7d932df2010-06-13 14:15:40 +0200716 qdev_init_gpio_in(&dev->qdev, hpet_handle_rtc_irq, 1);
717
aliguori16b29ae2008-12-17 23:28:44 +0000718 /* HPET Area */
Avi Kivity1eed09c2009-06-14 11:38:51 +0300719 iomemtype = cpu_register_io_memory(hpet_ram_read,
Alexander Graf2507c122010-12-08 12:05:37 +0100720 hpet_ram_write, s,
721 DEVICE_NATIVE_ENDIAN);
Jan Kiszka822557e2010-06-13 14:15:38 +0200722 sysbus_init_mmio(dev, 0x400, iomemtype);
723 return 0;
aliguori16b29ae2008-12-17 23:28:44 +0000724}
Jan Kiszka822557e2010-06-13 14:15:38 +0200725
726static SysBusDeviceInfo hpet_device_info = {
727 .qdev.name = "hpet",
728 .qdev.size = sizeof(HPETState),
729 .qdev.no_user = 1,
730 .qdev.vmsd = &vmstate_hpet,
731 .qdev.reset = hpet_reset,
732 .init = hpet_init,
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200733 .qdev.props = (Property[]) {
734 DEFINE_PROP_UINT8("timers", HPETState, num_timers, HPET_MIN_TIMERS),
Jan Kiszka8caa0062010-06-13 14:15:45 +0200735 DEFINE_PROP_BIT("msi", HPETState, flags, HPET_MSI_SUPPORT, false),
Jan Kiszkabe4b44c2010-06-13 14:15:44 +0200736 DEFINE_PROP_END_OF_LIST(),
737 },
Jan Kiszka822557e2010-06-13 14:15:38 +0200738};
739
740static void hpet_register_device(void)
741{
742 sysbus_register_withprop(&hpet_device_info);
743}
744
745device_init(hpet_register_device)