/* * Allwinner A10 timer device emulation * * Copyright (C) 2013 Li Guang * Written by Li Guang * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License * for more details. */ #include "qemu/osdep.h" #include "hw/irq.h" #include "hw/qdev-properties.h" #include "hw/sysbus.h" #include "hw/timer/allwinner-a10-pit.h" #include "migration/vmstate.h" #include "qemu/log.h" #include "qemu/main-loop.h" #include "qemu/module.h" static void a10_pit_update_irq(AwA10PITState *s) { int i; for (i = 0; i < AW_A10_PIT_TIMER_NR; i++) { qemu_set_irq(s->irq[i], !!(s->irq_status & s->irq_enable & (1 << i))); } } static uint64_t a10_pit_read(void *opaque, hwaddr offset, unsigned size) { AwA10PITState *s = AW_A10_PIT(opaque); uint8_t index; switch (offset) { case AW_A10_PIT_TIMER_IRQ_EN: return s->irq_enable; case AW_A10_PIT_TIMER_IRQ_ST: return s->irq_status; case AW_A10_PIT_TIMER_BASE ... AW_A10_PIT_TIMER_BASE_END: index = offset & 0xf0; index >>= 4; index -= 1; switch (offset & 0x0f) { case AW_A10_PIT_TIMER_CONTROL: return s->control[index]; case AW_A10_PIT_TIMER_INTERVAL: return s->interval[index]; case AW_A10_PIT_TIMER_COUNT: s->count[index] = ptimer_get_count(s->timer[index]); return s->count[index]; default: qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset 0x%x\n", __func__, (int)offset); break; } case AW_A10_PIT_WDOG_CONTROL: break; case AW_A10_PIT_WDOG_MODE: break; case AW_A10_PIT_COUNT_LO: return s->count_lo; case AW_A10_PIT_COUNT_HI: return s->count_hi; case AW_A10_PIT_COUNT_CTL: return s->count_ctl; default: qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset 0x%x\n", __func__, (int)offset); break; } return 0; } static void a10_pit_set_freq(AwA10PITState *s, int index) { uint32_t prescaler, source, source_freq; prescaler = 1 << extract32(s->control[index], 4, 3); source = extract32(s->control[index], 2, 2); source_freq = s->clk_freq[source]; if (source_freq) { ptimer_set_freq(s->timer[index], source_freq / prescaler); } else { qemu_log_mask(LOG_GUEST_ERROR, "%s: Invalid clock source %u\n", __func__, source); } } static void a10_pit_write(void *opaque, hwaddr offset, uint64_t value, unsigned size) { AwA10PITState *s = AW_A10_PIT(opaque); uint8_t index; switch (offset) { case AW_A10_PIT_TIMER_IRQ_EN: s->irq_enable = value; a10_pit_update_irq(s); break; case AW_A10_PIT_TIMER_IRQ_ST: s->irq_status &= ~value; a10_pit_update_irq(s); break; case AW_A10_PIT_TIMER_BASE ... AW_A10_PIT_TIMER_BASE_END: index = offset & 0xf0; index >>= 4; index -= 1; switch (offset & 0x0f) { case AW_A10_PIT_TIMER_CONTROL: s->control[index] = value; a10_pit_set_freq(s, index); if (s->control[index] & AW_A10_PIT_TIMER_RELOAD) { ptimer_set_count(s->timer[index], s->interval[index]); } if (s->control[index] & AW_A10_PIT_TIMER_EN) { int oneshot = 0; if (s->control[index] & AW_A10_PIT_TIMER_MODE) { oneshot = 1; } ptimer_run(s->timer[index], oneshot); } else { ptimer_stop(s->timer[index]); } break; case AW_A10_PIT_TIMER_INTERVAL: s->interval[index] = value; ptimer_set_limit(s->timer[index], s->interval[index], 1); break; case AW_A10_PIT_TIMER_COUNT: s->count[index] = value; break; default: qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset 0x%x\n", __func__, (int)offset); } break; case AW_A10_PIT_WDOG_CONTROL: s->watch_dog_control = value; break; case AW_A10_PIT_WDOG_MODE: s->watch_dog_mode = value; break; case AW_A10_PIT_COUNT_LO: s->count_lo = value; break; case AW_A10_PIT_COUNT_HI: s->count_hi = value; break; case AW_A10_PIT_COUNT_CTL: s->count_ctl = value; if (s->count_ctl & AW_A10_PIT_COUNT_RL_EN) { uint64_t tmp_count = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL); s->count_lo = tmp_count; s->count_hi = tmp_count >> 32; s->count_ctl &= ~AW_A10_PIT_COUNT_RL_EN; } if (s->count_ctl & AW_A10_PIT_COUNT_CLR_EN) { s->count_lo = 0; s->count_hi = 0; s->count_ctl &= ~AW_A10_PIT_COUNT_CLR_EN; } break; default: qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset 0x%x\n", __func__, (int)offset); break; } } static const MemoryRegionOps a10_pit_ops = { .read = a10_pit_read, .write = a10_pit_write, .endianness = DEVICE_NATIVE_ENDIAN, }; static Property a10_pit_properties[] = { DEFINE_PROP_UINT32("clk0-freq", AwA10PITState, clk_freq[0], 0), DEFINE_PROP_UINT32("clk1-freq", AwA10PITState, clk_freq[1], 0), DEFINE_PROP_UINT32("clk2-freq", AwA10PITState, clk_freq[2], 0), DEFINE_PROP_UINT32("clk3-freq", AwA10PITState, clk_freq[3], 0), DEFINE_PROP_END_OF_LIST(), }; static const VMStateDescription vmstate_a10_pit = { .name = "a10.pit", .version_id = 1, .minimum_version_id = 1, .fields = (VMStateField[]) { VMSTATE_UINT32(irq_enable, AwA10PITState), VMSTATE_UINT32(irq_status, AwA10PITState), VMSTATE_UINT32_ARRAY(control, AwA10PITState, AW_A10_PIT_TIMER_NR), VMSTATE_UINT32_ARRAY(interval, AwA10PITState, AW_A10_PIT_TIMER_NR), VMSTATE_UINT32_ARRAY(count, AwA10PITState, AW_A10_PIT_TIMER_NR), VMSTATE_UINT32(watch_dog_mode, AwA10PITState), VMSTATE_UINT32(watch_dog_control, AwA10PITState), VMSTATE_UINT32(count_lo, AwA10PITState), VMSTATE_UINT32(count_hi, AwA10PITState), VMSTATE_UINT32(count_ctl, AwA10PITState), VMSTATE_PTIMER_ARRAY(timer, AwA10PITState, AW_A10_PIT_TIMER_NR), VMSTATE_END_OF_LIST() } }; static void a10_pit_reset(DeviceState *dev) { AwA10PITState *s = AW_A10_PIT(dev); uint8_t i; s->irq_enable = 0; s->irq_status = 0; a10_pit_update_irq(s); for (i = 0; i < 6; i++) { s->control[i] = AW_A10_PIT_DEFAULT_CLOCK; s->interval[i] = 0; s->count[i] = 0; ptimer_stop(s->timer[i]); a10_pit_set_freq(s, i); } s->watch_dog_mode = 0; s->watch_dog_control = 0; s->count_lo = 0; s->count_hi = 0; s->count_ctl = 0; } static void a10_pit_timer_cb(void *opaque) { AwA10TimerContext *tc = opaque; AwA10PITState *s = tc->container; uint8_t i = tc->index; if (s->control[i] & AW_A10_PIT_TIMER_EN) { s->irq_status |= 1 << i; if (s->control[i] & AW_A10_PIT_TIMER_MODE) { ptimer_stop(s->timer[i]); s->control[i] &= ~AW_A10_PIT_TIMER_EN; } a10_pit_update_irq(s); } } static void a10_pit_init(Object *obj) { AwA10PITState *s = AW_A10_PIT(obj); SysBusDevice *sbd = SYS_BUS_DEVICE(obj); QEMUBH * bh[AW_A10_PIT_TIMER_NR]; uint8_t i; for (i = 0; i < AW_A10_PIT_TIMER_NR; i++) { sysbus_init_irq(sbd, &s->irq[i]); } memory_region_init_io(&s->iomem, OBJECT(s), &a10_pit_ops, s, TYPE_AW_A10_PIT, 0x400); sysbus_init_mmio(sbd, &s->iomem); for (i = 0; i < AW_A10_PIT_TIMER_NR; i++) { AwA10TimerContext *tc = &s->timer_context[i]; tc->container = s; tc->index = i; bh[i] = qemu_bh_new(a10_pit_timer_cb, tc); s->timer[i] = ptimer_init(bh[i], PTIMER_POLICY_DEFAULT); } } static void a10_pit_class_init(ObjectClass *klass, void *data) { DeviceClass *dc = DEVICE_CLASS(klass); dc->reset = a10_pit_reset; dc->props = a10_pit_properties; dc->desc = "allwinner a10 timer"; dc->vmsd = &vmstate_a10_pit; } static const TypeInfo a10_pit_info = { .name = TYPE_AW_A10_PIT, .parent = TYPE_SYS_BUS_DEVICE, .instance_size = sizeof(AwA10PITState), .instance_init = a10_pit_init, .class_init = a10_pit_class_init, }; static void a10_register_types(void) { type_register_static(&a10_pit_info); } type_init(a10_register_types);