1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include "hw/hw.h"
21#include "qemu/timer.h"
22#include "hw/arm/omap.h"
23struct omap_synctimer_s {
24 MemoryRegion iomem;
25 uint32_t val;
26 uint16_t readh;
27};
28
29
30static uint32_t omap_synctimer_read(struct omap_synctimer_s *s) {
31 return muldiv64(qemu_get_clock_ns(vm_clock), 0x8000, get_ticks_per_sec());
32}
33
34void omap_synctimer_reset(struct omap_synctimer_s *s)
35{
36 s->val = omap_synctimer_read(s);
37}
38
39static uint32_t omap_synctimer_readw(void *opaque, hwaddr addr)
40{
41 struct omap_synctimer_s *s = (struct omap_synctimer_s *) opaque;
42
43 switch (addr) {
44 case 0x00:
45 return 0x21;
46
47 case 0x10:
48 return omap_synctimer_read(s) - s->val;
49 }
50
51 OMAP_BAD_REG(addr);
52 return 0;
53}
54
55static uint32_t omap_synctimer_readh(void *opaque, hwaddr addr)
56{
57 struct omap_synctimer_s *s = (struct omap_synctimer_s *) opaque;
58 uint32_t ret;
59
60 if (addr & 2)
61 return s->readh;
62 else {
63 ret = omap_synctimer_readw(opaque, addr);
64 s->readh = ret >> 16;
65 return ret & 0xffff;
66 }
67}
68
69static void omap_synctimer_write(void *opaque, hwaddr addr,
70 uint32_t value)
71{
72 OMAP_BAD_REG(addr);
73}
74
75static const MemoryRegionOps omap_synctimer_ops = {
76 .old_mmio = {
77 .read = {
78 omap_badwidth_read32,
79 omap_synctimer_readh,
80 omap_synctimer_readw,
81 },
82 .write = {
83 omap_badwidth_write32,
84 omap_synctimer_write,
85 omap_synctimer_write,
86 },
87 },
88 .endianness = DEVICE_NATIVE_ENDIAN,
89};
90
91struct omap_synctimer_s *omap_synctimer_init(struct omap_target_agent_s *ta,
92 struct omap_mpu_state_s *mpu, omap_clk fclk, omap_clk iclk)
93{
94 struct omap_synctimer_s *s = g_malloc0(sizeof(*s));
95
96 omap_synctimer_reset(s);
97 memory_region_init_io(&s->iomem, NULL, &omap_synctimer_ops, s, "omap.synctimer",
98 omap_l4_region_size(ta, 0));
99 omap_l4_attach(ta, 0, &s->iomem);
100
101 return s;
102}
103