151f233ecSMark Cave-Ayland /*
251f233ecSMark Cave-Ayland * QEMU MOS6522 VIA emulation
351f233ecSMark Cave-Ayland *
451f233ecSMark Cave-Ayland * Copyright (c) 2004-2007 Fabrice Bellard
551f233ecSMark Cave-Ayland * Copyright (c) 2007 Jocelyn Mayer
651f233ecSMark Cave-Ayland * Copyright (c) 2018 Mark Cave-Ayland
751f233ecSMark Cave-Ayland *
851f233ecSMark Cave-Ayland * Permission is hereby granted, free of charge, to any person obtaining a copy
951f233ecSMark Cave-Ayland * of this software and associated documentation files (the "Software"), to deal
1051f233ecSMark Cave-Ayland * in the Software without restriction, including without limitation the rights
1151f233ecSMark Cave-Ayland * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
1251f233ecSMark Cave-Ayland * copies of the Software, and to permit persons to whom the Software is
1351f233ecSMark Cave-Ayland * furnished to do so, subject to the following conditions:
1451f233ecSMark Cave-Ayland *
1551f233ecSMark Cave-Ayland * The above copyright notice and this permission notice shall be included in
1651f233ecSMark Cave-Ayland * all copies or substantial portions of the Software.
1751f233ecSMark Cave-Ayland *
1851f233ecSMark Cave-Ayland * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
1951f233ecSMark Cave-Ayland * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
2051f233ecSMark Cave-Ayland * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
2151f233ecSMark Cave-Ayland * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
2251f233ecSMark Cave-Ayland * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
2351f233ecSMark Cave-Ayland * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
2451f233ecSMark Cave-Ayland * THE SOFTWARE.
2551f233ecSMark Cave-Ayland */
260b8fa32fSMarkus Armbruster
2751f233ecSMark Cave-Ayland #include "qemu/osdep.h"
2864552b6bSMarkus Armbruster #include "hw/irq.h"
2951f233ecSMark Cave-Ayland #include "hw/misc/mos6522.h"
30a27bd6c7SMarkus Armbruster #include "hw/qdev-properties.h"
31d6454270SMarkus Armbruster #include "migration/vmstate.h"
32409e9f71SMark Cave-Ayland #include "monitor/monitor.h"
33409e9f71SMark Cave-Ayland #include "monitor/hmp.h"
34409e9f71SMark Cave-Ayland #include "qapi/type-helpers.h"
3551f233ecSMark Cave-Ayland #include "qemu/timer.h"
3651f233ecSMark Cave-Ayland #include "qemu/cutils.h"
3751f233ecSMark Cave-Ayland #include "qemu/log.h"
380b8fa32fSMarkus Armbruster #include "qemu/module.h"
3951f233ecSMark Cave-Ayland #include "trace.h"
4051f233ecSMark Cave-Ayland
416c726698SMark Cave-Ayland
426c726698SMark Cave-Ayland static const char *mos6522_reg_names[MOS6522_NUM_REGS] = {
436c726698SMark Cave-Ayland "ORB", "ORA", "DDRB", "DDRA", "T1CL", "T1CH", "T1LL", "T1LH",
446c726698SMark Cave-Ayland "T2CL", "T2CH", "SR", "ACR", "PCR", "IFR", "IER", "ANH"
456c726698SMark Cave-Ayland };
466c726698SMark Cave-Ayland
4751f233ecSMark Cave-Ayland /* XXX: implement all timer modes */
4851f233ecSMark Cave-Ayland
49cd8843ffSLaurent Vivier static void mos6522_timer1_update(MOS6522State *s, MOS6522Timer *ti,
50cd8843ffSLaurent Vivier int64_t current_time);
51cd8843ffSLaurent Vivier static void mos6522_timer2_update(MOS6522State *s, MOS6522Timer *ti,
5251f233ecSMark Cave-Ayland int64_t current_time);
5351f233ecSMark Cave-Ayland
mos6522_update_irq(MOS6522State * s)5451f233ecSMark Cave-Ayland static void mos6522_update_irq(MOS6522State *s)
5551f233ecSMark Cave-Ayland {
5632a8c27bSMark Cave-Ayland if (s->ifr & s->ier) {
5751f233ecSMark Cave-Ayland qemu_irq_raise(s->irq);
5851f233ecSMark Cave-Ayland } else {
5951f233ecSMark Cave-Ayland qemu_irq_lower(s->irq);
6051f233ecSMark Cave-Ayland }
6151f233ecSMark Cave-Ayland }
6251f233ecSMark Cave-Ayland
mos6522_set_irq(void * opaque,int n,int level)63ebe5bca2SMark Cave-Ayland static void mos6522_set_irq(void *opaque, int n, int level)
64ebe5bca2SMark Cave-Ayland {
65ebe5bca2SMark Cave-Ayland MOS6522State *s = MOS6522(opaque);
66b793b4efSMark Cave-Ayland int last_level = !!(s->last_irq_levels & (1 << n));
67b793b4efSMark Cave-Ayland uint8_t last_ifr = s->ifr;
68b793b4efSMark Cave-Ayland bool positive_edge = true;
69b793b4efSMark Cave-Ayland int ctrl;
70ebe5bca2SMark Cave-Ayland
71b793b4efSMark Cave-Ayland /*
72b793b4efSMark Cave-Ayland * SR_INT is managed by mos6522 instances and cleared upon SR
73b793b4efSMark Cave-Ayland * read. It is only the external CA1/2 and CB1/2 lines that
74b793b4efSMark Cave-Ayland * are edge-triggered and latched in IFR
75b793b4efSMark Cave-Ayland */
76b793b4efSMark Cave-Ayland if (n != SR_INT_BIT && level == last_level) {
77b793b4efSMark Cave-Ayland return;
78ebe5bca2SMark Cave-Ayland }
79ebe5bca2SMark Cave-Ayland
80b793b4efSMark Cave-Ayland /* Detect negative edge trigger */
81b793b4efSMark Cave-Ayland if (last_level == 1 && level == 0) {
82b793b4efSMark Cave-Ayland positive_edge = false;
83b793b4efSMark Cave-Ayland }
84b793b4efSMark Cave-Ayland
85b793b4efSMark Cave-Ayland switch (n) {
86b793b4efSMark Cave-Ayland case CA2_INT_BIT:
87b793b4efSMark Cave-Ayland ctrl = (s->pcr & CA2_CTRL_MASK) >> CA2_CTRL_SHIFT;
88b793b4efSMark Cave-Ayland if ((positive_edge && (ctrl & C2_POS)) ||
89b793b4efSMark Cave-Ayland (!positive_edge && !(ctrl & C2_POS))) {
90b793b4efSMark Cave-Ayland s->ifr |= 1 << n;
91b793b4efSMark Cave-Ayland }
92b793b4efSMark Cave-Ayland break;
93b793b4efSMark Cave-Ayland case CA1_INT_BIT:
94b793b4efSMark Cave-Ayland ctrl = (s->pcr & CA1_CTRL_MASK) >> CA1_CTRL_SHIFT;
95b793b4efSMark Cave-Ayland if ((positive_edge && (ctrl & C1_POS)) ||
96b793b4efSMark Cave-Ayland (!positive_edge && !(ctrl & C1_POS))) {
97b793b4efSMark Cave-Ayland s->ifr |= 1 << n;
98b793b4efSMark Cave-Ayland }
99b793b4efSMark Cave-Ayland break;
100b793b4efSMark Cave-Ayland case SR_INT_BIT:
101b793b4efSMark Cave-Ayland s->ifr |= 1 << n;
102b793b4efSMark Cave-Ayland break;
103b793b4efSMark Cave-Ayland case CB2_INT_BIT:
104b793b4efSMark Cave-Ayland ctrl = (s->pcr & CB2_CTRL_MASK) >> CB2_CTRL_SHIFT;
105b793b4efSMark Cave-Ayland if ((positive_edge && (ctrl & C2_POS)) ||
106b793b4efSMark Cave-Ayland (!positive_edge && !(ctrl & C2_POS))) {
107b793b4efSMark Cave-Ayland s->ifr |= 1 << n;
108b793b4efSMark Cave-Ayland }
109b793b4efSMark Cave-Ayland break;
110b793b4efSMark Cave-Ayland case CB1_INT_BIT:
111b793b4efSMark Cave-Ayland ctrl = (s->pcr & CB1_CTRL_MASK) >> CB1_CTRL_SHIFT;
112b793b4efSMark Cave-Ayland if ((positive_edge && (ctrl & C1_POS)) ||
113b793b4efSMark Cave-Ayland (!positive_edge && !(ctrl & C1_POS))) {
114b793b4efSMark Cave-Ayland s->ifr |= 1 << n;
115b793b4efSMark Cave-Ayland }
116b793b4efSMark Cave-Ayland break;
117b793b4efSMark Cave-Ayland }
118b793b4efSMark Cave-Ayland
119b793b4efSMark Cave-Ayland if (s->ifr != last_ifr) {
120ebe5bca2SMark Cave-Ayland mos6522_update_irq(s);
121b793b4efSMark Cave-Ayland }
122d4454e41SMark Cave-Ayland
123d4454e41SMark Cave-Ayland if (level) {
124d4454e41SMark Cave-Ayland s->last_irq_levels |= 1 << n;
125d4454e41SMark Cave-Ayland } else {
126d4454e41SMark Cave-Ayland s->last_irq_levels &= ~(1 << n);
127d4454e41SMark Cave-Ayland }
128ebe5bca2SMark Cave-Ayland }
129ebe5bca2SMark Cave-Ayland
get_counter_value(MOS6522State * s,MOS6522Timer * ti)13051f233ecSMark Cave-Ayland static uint64_t get_counter_value(MOS6522State *s, MOS6522Timer *ti)
13151f233ecSMark Cave-Ayland {
1329db70dacSEduardo Habkost MOS6522DeviceClass *mdc = MOS6522_GET_CLASS(s);
13351f233ecSMark Cave-Ayland
13451f233ecSMark Cave-Ayland if (ti->index == 0) {
13551f233ecSMark Cave-Ayland return mdc->get_timer1_counter_value(s, ti);
13651f233ecSMark Cave-Ayland } else {
13751f233ecSMark Cave-Ayland return mdc->get_timer2_counter_value(s, ti);
13851f233ecSMark Cave-Ayland }
13951f233ecSMark Cave-Ayland }
14051f233ecSMark Cave-Ayland
get_load_time(MOS6522State * s,MOS6522Timer * ti)14151f233ecSMark Cave-Ayland static uint64_t get_load_time(MOS6522State *s, MOS6522Timer *ti)
14251f233ecSMark Cave-Ayland {
1439db70dacSEduardo Habkost MOS6522DeviceClass *mdc = MOS6522_GET_CLASS(s);
14451f233ecSMark Cave-Ayland
14551f233ecSMark Cave-Ayland if (ti->index == 0) {
14651f233ecSMark Cave-Ayland return mdc->get_timer1_load_time(s, ti);
14751f233ecSMark Cave-Ayland } else {
14851f233ecSMark Cave-Ayland return mdc->get_timer2_load_time(s, ti);
14951f233ecSMark Cave-Ayland }
15051f233ecSMark Cave-Ayland }
15151f233ecSMark Cave-Ayland
get_counter(MOS6522State * s,MOS6522Timer * ti)15251f233ecSMark Cave-Ayland static unsigned int get_counter(MOS6522State *s, MOS6522Timer *ti)
15351f233ecSMark Cave-Ayland {
15451f233ecSMark Cave-Ayland int64_t d;
15551f233ecSMark Cave-Ayland unsigned int counter;
15651f233ecSMark Cave-Ayland
15751f233ecSMark Cave-Ayland d = get_counter_value(s, ti);
15851f233ecSMark Cave-Ayland
15951f233ecSMark Cave-Ayland if (ti->index == 0) {
16051f233ecSMark Cave-Ayland /* the timer goes down from latch to -1 (period of latch + 2) */
16151f233ecSMark Cave-Ayland if (d <= (ti->counter_value + 1)) {
16251f233ecSMark Cave-Ayland counter = (ti->counter_value - d) & 0xffff;
16351f233ecSMark Cave-Ayland } else {
16451f233ecSMark Cave-Ayland counter = (d - (ti->counter_value + 1)) % (ti->latch + 2);
16551f233ecSMark Cave-Ayland counter = (ti->latch - counter) & 0xffff;
16651f233ecSMark Cave-Ayland }
16751f233ecSMark Cave-Ayland } else {
16851f233ecSMark Cave-Ayland counter = (ti->counter_value - d) & 0xffff;
16951f233ecSMark Cave-Ayland }
17051f233ecSMark Cave-Ayland return counter;
17151f233ecSMark Cave-Ayland }
17251f233ecSMark Cave-Ayland
set_counter(MOS6522State * s,MOS6522Timer * ti,unsigned int val)17351f233ecSMark Cave-Ayland static void set_counter(MOS6522State *s, MOS6522Timer *ti, unsigned int val)
17451f233ecSMark Cave-Ayland {
17551f233ecSMark Cave-Ayland trace_mos6522_set_counter(1 + ti->index, val);
17651f233ecSMark Cave-Ayland ti->load_time = get_load_time(s, ti);
17751f233ecSMark Cave-Ayland ti->counter_value = val;
178cd8843ffSLaurent Vivier if (ti->index == 0) {
179cd8843ffSLaurent Vivier mos6522_timer1_update(s, ti, ti->load_time);
180cd8843ffSLaurent Vivier } else {
181cd8843ffSLaurent Vivier mos6522_timer2_update(s, ti, ti->load_time);
182cd8843ffSLaurent Vivier }
18351f233ecSMark Cave-Ayland }
18451f233ecSMark Cave-Ayland
get_next_irq_time(MOS6522State * s,MOS6522Timer * ti,int64_t current_time)18551f233ecSMark Cave-Ayland static int64_t get_next_irq_time(MOS6522State *s, MOS6522Timer *ti,
18651f233ecSMark Cave-Ayland int64_t current_time)
18751f233ecSMark Cave-Ayland {
18851f233ecSMark Cave-Ayland int64_t d, next_time;
18951f233ecSMark Cave-Ayland unsigned int counter;
19051f233ecSMark Cave-Ayland
1916cf80f90SLaurent Vivier if (ti->frequency == 0) {
1926cf80f90SLaurent Vivier return INT64_MAX;
1936cf80f90SLaurent Vivier }
1946cf80f90SLaurent Vivier
19551f233ecSMark Cave-Ayland /* current counter value */
19651f233ecSMark Cave-Ayland d = muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) - ti->load_time,
19751f233ecSMark Cave-Ayland ti->frequency, NANOSECONDS_PER_SECOND);
19851f233ecSMark Cave-Ayland
19951f233ecSMark Cave-Ayland /* the timer goes down from latch to -1 (period of latch + 2) */
20051f233ecSMark Cave-Ayland if (d <= (ti->counter_value + 1)) {
20151f233ecSMark Cave-Ayland counter = (ti->counter_value - d) & 0xffff;
20251f233ecSMark Cave-Ayland } else {
20351f233ecSMark Cave-Ayland counter = (d - (ti->counter_value + 1)) % (ti->latch + 2);
20451f233ecSMark Cave-Ayland counter = (ti->latch - counter) & 0xffff;
20551f233ecSMark Cave-Ayland }
20651f233ecSMark Cave-Ayland
20751f233ecSMark Cave-Ayland /* Note: we consider the irq is raised on 0 */
20851f233ecSMark Cave-Ayland if (counter == 0xffff) {
20951f233ecSMark Cave-Ayland next_time = d + ti->latch + 1;
21051f233ecSMark Cave-Ayland } else if (counter == 0) {
21151f233ecSMark Cave-Ayland next_time = d + ti->latch + 2;
21251f233ecSMark Cave-Ayland } else {
21351f233ecSMark Cave-Ayland next_time = d + counter;
21451f233ecSMark Cave-Ayland }
21551f233ecSMark Cave-Ayland trace_mos6522_get_next_irq_time(ti->latch, d, next_time - d);
21651f233ecSMark Cave-Ayland next_time = muldiv64(next_time, NANOSECONDS_PER_SECOND, ti->frequency) +
21751f233ecSMark Cave-Ayland ti->load_time;
218cd8843ffSLaurent Vivier
21951f233ecSMark Cave-Ayland if (next_time <= current_time) {
22051f233ecSMark Cave-Ayland next_time = current_time + 1;
22151f233ecSMark Cave-Ayland }
22251f233ecSMark Cave-Ayland return next_time;
22351f233ecSMark Cave-Ayland }
22451f233ecSMark Cave-Ayland
mos6522_timer1_update(MOS6522State * s,MOS6522Timer * ti,int64_t current_time)225cd8843ffSLaurent Vivier static void mos6522_timer1_update(MOS6522State *s, MOS6522Timer *ti,
22651f233ecSMark Cave-Ayland int64_t current_time)
22751f233ecSMark Cave-Ayland {
22851f233ecSMark Cave-Ayland if (!ti->timer) {
22951f233ecSMark Cave-Ayland return;
23051f233ecSMark Cave-Ayland }
2316cf80f90SLaurent Vivier ti->next_irq_time = get_next_irq_time(s, ti, current_time);
232cd8843ffSLaurent Vivier if ((s->ier & T1_INT) == 0 || (s->acr & T1MODE) != T1MODE_CONT) {
233cd8843ffSLaurent Vivier timer_del(ti->timer);
234cd8843ffSLaurent Vivier } else {
235cd8843ffSLaurent Vivier timer_mod(ti->timer, ti->next_irq_time);
236cd8843ffSLaurent Vivier }
237cd8843ffSLaurent Vivier }
238cd8843ffSLaurent Vivier
mos6522_timer2_update(MOS6522State * s,MOS6522Timer * ti,int64_t current_time)239cd8843ffSLaurent Vivier static void mos6522_timer2_update(MOS6522State *s, MOS6522Timer *ti,
240cd8843ffSLaurent Vivier int64_t current_time)
241cd8843ffSLaurent Vivier {
242cd8843ffSLaurent Vivier if (!ti->timer) {
243cd8843ffSLaurent Vivier return;
244cd8843ffSLaurent Vivier }
2456cf80f90SLaurent Vivier ti->next_irq_time = get_next_irq_time(s, ti, current_time);
246cd8843ffSLaurent Vivier if ((s->ier & T2_INT) == 0) {
24751f233ecSMark Cave-Ayland timer_del(ti->timer);
24851f233ecSMark Cave-Ayland } else {
24951f233ecSMark Cave-Ayland timer_mod(ti->timer, ti->next_irq_time);
25051f233ecSMark Cave-Ayland }
25151f233ecSMark Cave-Ayland }
25251f233ecSMark Cave-Ayland
mos6522_timer1(void * opaque)25351f233ecSMark Cave-Ayland static void mos6522_timer1(void *opaque)
25451f233ecSMark Cave-Ayland {
25551f233ecSMark Cave-Ayland MOS6522State *s = opaque;
25651f233ecSMark Cave-Ayland MOS6522Timer *ti = &s->timers[0];
25751f233ecSMark Cave-Ayland
258cd8843ffSLaurent Vivier mos6522_timer1_update(s, ti, ti->next_irq_time);
25951f233ecSMark Cave-Ayland s->ifr |= T1_INT;
26051f233ecSMark Cave-Ayland mos6522_update_irq(s);
26151f233ecSMark Cave-Ayland }
26251f233ecSMark Cave-Ayland
mos6522_timer2(void * opaque)26351f233ecSMark Cave-Ayland static void mos6522_timer2(void *opaque)
26451f233ecSMark Cave-Ayland {
26551f233ecSMark Cave-Ayland MOS6522State *s = opaque;
26651f233ecSMark Cave-Ayland MOS6522Timer *ti = &s->timers[1];
26751f233ecSMark Cave-Ayland
268cd8843ffSLaurent Vivier mos6522_timer2_update(s, ti, ti->next_irq_time);
26951f233ecSMark Cave-Ayland s->ifr |= T2_INT;
27051f233ecSMark Cave-Ayland mos6522_update_irq(s);
27151f233ecSMark Cave-Ayland }
27251f233ecSMark Cave-Ayland
mos6522_get_counter_value(MOS6522State * s,MOS6522Timer * ti)27351f233ecSMark Cave-Ayland static uint64_t mos6522_get_counter_value(MOS6522State *s, MOS6522Timer *ti)
27451f233ecSMark Cave-Ayland {
2754a4ff4c5SLaurent Vivier return muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) - ti->load_time,
27651f233ecSMark Cave-Ayland ti->frequency, NANOSECONDS_PER_SECOND);
27751f233ecSMark Cave-Ayland }
27851f233ecSMark Cave-Ayland
mos6522_get_load_time(MOS6522State * s,MOS6522Timer * ti)27951f233ecSMark Cave-Ayland static uint64_t mos6522_get_load_time(MOS6522State *s, MOS6522Timer *ti)
28051f233ecSMark Cave-Ayland {
28151f233ecSMark Cave-Ayland uint64_t load_time = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
28251f233ecSMark Cave-Ayland
28351f233ecSMark Cave-Ayland return load_time;
28451f233ecSMark Cave-Ayland }
28551f233ecSMark Cave-Ayland
mos6522_portA_write(MOS6522State * s)28651f233ecSMark Cave-Ayland static void mos6522_portA_write(MOS6522State *s)
28751f233ecSMark Cave-Ayland {
288c9bca798SPhilippe Mathieu-Daudé qemu_log_mask(LOG_UNIMP, "portA_write unimplemented\n");
28951f233ecSMark Cave-Ayland }
29051f233ecSMark Cave-Ayland
mos6522_portB_write(MOS6522State * s)29151f233ecSMark Cave-Ayland static void mos6522_portB_write(MOS6522State *s)
29251f233ecSMark Cave-Ayland {
293c9bca798SPhilippe Mathieu-Daudé qemu_log_mask(LOG_UNIMP, "portB_write unimplemented\n");
29451f233ecSMark Cave-Ayland }
29551f233ecSMark Cave-Ayland
mos6522_read(void * opaque,hwaddr addr,unsigned size)29651f233ecSMark Cave-Ayland uint64_t mos6522_read(void *opaque, hwaddr addr, unsigned size)
29751f233ecSMark Cave-Ayland {
29851f233ecSMark Cave-Ayland MOS6522State *s = opaque;
29951f233ecSMark Cave-Ayland uint32_t val;
300b793b4efSMark Cave-Ayland int ctrl;
301cd8843ffSLaurent Vivier int64_t now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
30251f233ecSMark Cave-Ayland
303cd8843ffSLaurent Vivier if (now >= s->timers[0].next_irq_time) {
304cd8843ffSLaurent Vivier mos6522_timer1_update(s, &s->timers[0], now);
305cd8843ffSLaurent Vivier s->ifr |= T1_INT;
306cd8843ffSLaurent Vivier }
307cd8843ffSLaurent Vivier if (now >= s->timers[1].next_irq_time) {
308cd8843ffSLaurent Vivier mos6522_timer2_update(s, &s->timers[1], now);
309cd8843ffSLaurent Vivier s->ifr |= T2_INT;
310cd8843ffSLaurent Vivier }
31151f233ecSMark Cave-Ayland switch (addr) {
31251f233ecSMark Cave-Ayland case VIA_REG_B:
31351f233ecSMark Cave-Ayland val = s->b;
314b793b4efSMark Cave-Ayland ctrl = (s->pcr & CB2_CTRL_MASK) >> CB2_CTRL_SHIFT;
315b793b4efSMark Cave-Ayland if (!(ctrl & C2_IND)) {
316b793b4efSMark Cave-Ayland s->ifr &= ~CB2_INT;
317b793b4efSMark Cave-Ayland }
318b793b4efSMark Cave-Ayland s->ifr &= ~CB1_INT;
319b793b4efSMark Cave-Ayland mos6522_update_irq(s);
32051f233ecSMark Cave-Ayland break;
32151f233ecSMark Cave-Ayland case VIA_REG_A:
322068fe58cSLaurent Vivier qemu_log_mask(LOG_UNIMP, "Read access to register A with handshake");
323068fe58cSLaurent Vivier /* fall through */
324068fe58cSLaurent Vivier case VIA_REG_ANH:
32551f233ecSMark Cave-Ayland val = s->a;
326b793b4efSMark Cave-Ayland ctrl = (s->pcr & CA2_CTRL_MASK) >> CA2_CTRL_SHIFT;
327b793b4efSMark Cave-Ayland if (!(ctrl & C2_IND)) {
328b793b4efSMark Cave-Ayland s->ifr &= ~CA2_INT;
329b793b4efSMark Cave-Ayland }
330b793b4efSMark Cave-Ayland s->ifr &= ~CA1_INT;
331b793b4efSMark Cave-Ayland mos6522_update_irq(s);
33251f233ecSMark Cave-Ayland break;
33351f233ecSMark Cave-Ayland case VIA_REG_DIRB:
33451f233ecSMark Cave-Ayland val = s->dirb;
33551f233ecSMark Cave-Ayland break;
33651f233ecSMark Cave-Ayland case VIA_REG_DIRA:
33751f233ecSMark Cave-Ayland val = s->dira;
33851f233ecSMark Cave-Ayland break;
33951f233ecSMark Cave-Ayland case VIA_REG_T1CL:
34051f233ecSMark Cave-Ayland val = get_counter(s, &s->timers[0]) & 0xff;
34151f233ecSMark Cave-Ayland s->ifr &= ~T1_INT;
34251f233ecSMark Cave-Ayland mos6522_update_irq(s);
34351f233ecSMark Cave-Ayland break;
34451f233ecSMark Cave-Ayland case VIA_REG_T1CH:
34551f233ecSMark Cave-Ayland val = get_counter(s, &s->timers[0]) >> 8;
34651f233ecSMark Cave-Ayland mos6522_update_irq(s);
34751f233ecSMark Cave-Ayland break;
34851f233ecSMark Cave-Ayland case VIA_REG_T1LL:
34951f233ecSMark Cave-Ayland val = s->timers[0].latch & 0xff;
35051f233ecSMark Cave-Ayland break;
35151f233ecSMark Cave-Ayland case VIA_REG_T1LH:
35251f233ecSMark Cave-Ayland /* XXX: check this */
35351f233ecSMark Cave-Ayland val = (s->timers[0].latch >> 8) & 0xff;
35451f233ecSMark Cave-Ayland break;
35551f233ecSMark Cave-Ayland case VIA_REG_T2CL:
35651f233ecSMark Cave-Ayland val = get_counter(s, &s->timers[1]) & 0xff;
35751f233ecSMark Cave-Ayland s->ifr &= ~T2_INT;
35851f233ecSMark Cave-Ayland mos6522_update_irq(s);
35951f233ecSMark Cave-Ayland break;
36051f233ecSMark Cave-Ayland case VIA_REG_T2CH:
36151f233ecSMark Cave-Ayland val = get_counter(s, &s->timers[1]) >> 8;
36251f233ecSMark Cave-Ayland break;
36351f233ecSMark Cave-Ayland case VIA_REG_SR:
36451f233ecSMark Cave-Ayland val = s->sr;
3657f5d6517SMark Cave-Ayland s->ifr &= ~SR_INT;
36651f233ecSMark Cave-Ayland mos6522_update_irq(s);
36751f233ecSMark Cave-Ayland break;
36851f233ecSMark Cave-Ayland case VIA_REG_ACR:
36951f233ecSMark Cave-Ayland val = s->acr;
37051f233ecSMark Cave-Ayland break;
37151f233ecSMark Cave-Ayland case VIA_REG_PCR:
37251f233ecSMark Cave-Ayland val = s->pcr;
37351f233ecSMark Cave-Ayland break;
37451f233ecSMark Cave-Ayland case VIA_REG_IFR:
37551f233ecSMark Cave-Ayland val = s->ifr;
37651f233ecSMark Cave-Ayland if (s->ifr & s->ier) {
37751f233ecSMark Cave-Ayland val |= 0x80;
37851f233ecSMark Cave-Ayland }
37951f233ecSMark Cave-Ayland break;
38051f233ecSMark Cave-Ayland case VIA_REG_IER:
38151f233ecSMark Cave-Ayland val = s->ier | 0x80;
38251f233ecSMark Cave-Ayland break;
38351f233ecSMark Cave-Ayland default:
384068fe58cSLaurent Vivier g_assert_not_reached();
38551f233ecSMark Cave-Ayland }
38651f233ecSMark Cave-Ayland
38751f233ecSMark Cave-Ayland if (addr != VIA_REG_IFR || val != 0) {
3886c726698SMark Cave-Ayland trace_mos6522_read(addr, mos6522_reg_names[addr], val);
38951f233ecSMark Cave-Ayland }
39051f233ecSMark Cave-Ayland
39151f233ecSMark Cave-Ayland return val;
39251f233ecSMark Cave-Ayland }
39351f233ecSMark Cave-Ayland
mos6522_write(void * opaque,hwaddr addr,uint64_t val,unsigned size)39451f233ecSMark Cave-Ayland void mos6522_write(void *opaque, hwaddr addr, uint64_t val, unsigned size)
39551f233ecSMark Cave-Ayland {
39651f233ecSMark Cave-Ayland MOS6522State *s = opaque;
3979db70dacSEduardo Habkost MOS6522DeviceClass *mdc = MOS6522_GET_CLASS(s);
398b793b4efSMark Cave-Ayland int ctrl;
39951f233ecSMark Cave-Ayland
4006c726698SMark Cave-Ayland trace_mos6522_write(addr, mos6522_reg_names[addr], val);
40151f233ecSMark Cave-Ayland
40251f233ecSMark Cave-Ayland switch (addr) {
40351f233ecSMark Cave-Ayland case VIA_REG_B:
40451f233ecSMark Cave-Ayland s->b = (s->b & ~s->dirb) | (val & s->dirb);
40551f233ecSMark Cave-Ayland mdc->portB_write(s);
406b793b4efSMark Cave-Ayland ctrl = (s->pcr & CB2_CTRL_MASK) >> CB2_CTRL_SHIFT;
407b793b4efSMark Cave-Ayland if (!(ctrl & C2_IND)) {
408b793b4efSMark Cave-Ayland s->ifr &= ~CB2_INT;
409b793b4efSMark Cave-Ayland }
410b793b4efSMark Cave-Ayland s->ifr &= ~CB1_INT;
411b793b4efSMark Cave-Ayland mos6522_update_irq(s);
41251f233ecSMark Cave-Ayland break;
41351f233ecSMark Cave-Ayland case VIA_REG_A:
414068fe58cSLaurent Vivier qemu_log_mask(LOG_UNIMP, "Write access to register A with handshake");
415068fe58cSLaurent Vivier /* fall through */
416068fe58cSLaurent Vivier case VIA_REG_ANH:
41751f233ecSMark Cave-Ayland s->a = (s->a & ~s->dira) | (val & s->dira);
41851f233ecSMark Cave-Ayland mdc->portA_write(s);
419b793b4efSMark Cave-Ayland ctrl = (s->pcr & CA2_CTRL_MASK) >> CA2_CTRL_SHIFT;
420b793b4efSMark Cave-Ayland if (!(ctrl & C2_IND)) {
421b793b4efSMark Cave-Ayland s->ifr &= ~CA2_INT;
422b793b4efSMark Cave-Ayland }
423b793b4efSMark Cave-Ayland s->ifr &= ~CA1_INT;
424b793b4efSMark Cave-Ayland mos6522_update_irq(s);
42551f233ecSMark Cave-Ayland break;
42651f233ecSMark Cave-Ayland case VIA_REG_DIRB:
42751f233ecSMark Cave-Ayland s->dirb = val;
42851f233ecSMark Cave-Ayland break;
42951f233ecSMark Cave-Ayland case VIA_REG_DIRA:
43051f233ecSMark Cave-Ayland s->dira = val;
43151f233ecSMark Cave-Ayland break;
43251f233ecSMark Cave-Ayland case VIA_REG_T1CL:
43351f233ecSMark Cave-Ayland s->timers[0].latch = (s->timers[0].latch & 0xff00) | val;
434cd8843ffSLaurent Vivier mos6522_timer1_update(s, &s->timers[0],
43551f233ecSMark Cave-Ayland qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL));
43651f233ecSMark Cave-Ayland break;
43751f233ecSMark Cave-Ayland case VIA_REG_T1CH:
43851f233ecSMark Cave-Ayland s->timers[0].latch = (s->timers[0].latch & 0xff) | (val << 8);
43951f233ecSMark Cave-Ayland s->ifr &= ~T1_INT;
44051f233ecSMark Cave-Ayland set_counter(s, &s->timers[0], s->timers[0].latch);
44151f233ecSMark Cave-Ayland break;
44251f233ecSMark Cave-Ayland case VIA_REG_T1LL:
44351f233ecSMark Cave-Ayland s->timers[0].latch = (s->timers[0].latch & 0xff00) | val;
444cd8843ffSLaurent Vivier mos6522_timer1_update(s, &s->timers[0],
44551f233ecSMark Cave-Ayland qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL));
44651f233ecSMark Cave-Ayland break;
44751f233ecSMark Cave-Ayland case VIA_REG_T1LH:
44851f233ecSMark Cave-Ayland s->timers[0].latch = (s->timers[0].latch & 0xff) | (val << 8);
44951f233ecSMark Cave-Ayland s->ifr &= ~T1_INT;
450cd8843ffSLaurent Vivier mos6522_timer1_update(s, &s->timers[0],
45151f233ecSMark Cave-Ayland qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL));
45251f233ecSMark Cave-Ayland break;
45351f233ecSMark Cave-Ayland case VIA_REG_T2CL:
45451f233ecSMark Cave-Ayland s->timers[1].latch = (s->timers[1].latch & 0xff00) | val;
45551f233ecSMark Cave-Ayland break;
45651f233ecSMark Cave-Ayland case VIA_REG_T2CH:
45751f233ecSMark Cave-Ayland /* To ensure T2 generates an interrupt on zero crossing with the
45851f233ecSMark Cave-Ayland common timer code, write the value directly from the latch to
45951f233ecSMark Cave-Ayland the counter */
46051f233ecSMark Cave-Ayland s->timers[1].latch = (s->timers[1].latch & 0xff) | (val << 8);
46151f233ecSMark Cave-Ayland s->ifr &= ~T2_INT;
46251f233ecSMark Cave-Ayland set_counter(s, &s->timers[1], s->timers[1].latch);
46351f233ecSMark Cave-Ayland break;
46451f233ecSMark Cave-Ayland case VIA_REG_SR:
46551f233ecSMark Cave-Ayland s->sr = val;
46651f233ecSMark Cave-Ayland break;
46751f233ecSMark Cave-Ayland case VIA_REG_ACR:
46851f233ecSMark Cave-Ayland s->acr = val;
469cd8843ffSLaurent Vivier mos6522_timer1_update(s, &s->timers[0],
47051f233ecSMark Cave-Ayland qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL));
47151f233ecSMark Cave-Ayland break;
47251f233ecSMark Cave-Ayland case VIA_REG_PCR:
47351f233ecSMark Cave-Ayland s->pcr = val;
47451f233ecSMark Cave-Ayland break;
47551f233ecSMark Cave-Ayland case VIA_REG_IFR:
47651f233ecSMark Cave-Ayland /* reset bits */
47751f233ecSMark Cave-Ayland s->ifr &= ~val;
47851f233ecSMark Cave-Ayland mos6522_update_irq(s);
47951f233ecSMark Cave-Ayland break;
48051f233ecSMark Cave-Ayland case VIA_REG_IER:
48151f233ecSMark Cave-Ayland if (val & IER_SET) {
48251f233ecSMark Cave-Ayland /* set bits */
48351f233ecSMark Cave-Ayland s->ier |= val & 0x7f;
48451f233ecSMark Cave-Ayland } else {
48551f233ecSMark Cave-Ayland /* reset bits */
48651f233ecSMark Cave-Ayland s->ier &= ~val;
48751f233ecSMark Cave-Ayland }
48851f233ecSMark Cave-Ayland mos6522_update_irq(s);
489cd8843ffSLaurent Vivier /* if IER is modified starts needed timers */
490cd8843ffSLaurent Vivier mos6522_timer1_update(s, &s->timers[0],
491cd8843ffSLaurent Vivier qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL));
492cd8843ffSLaurent Vivier mos6522_timer2_update(s, &s->timers[1],
493cd8843ffSLaurent Vivier qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL));
49451f233ecSMark Cave-Ayland break;
49551f233ecSMark Cave-Ayland default:
496068fe58cSLaurent Vivier g_assert_not_reached();
49751f233ecSMark Cave-Ayland }
49851f233ecSMark Cave-Ayland }
49951f233ecSMark Cave-Ayland
qmp_x_query_via_foreach(Object * obj,void * opaque)500409e9f71SMark Cave-Ayland static int qmp_x_query_via_foreach(Object *obj, void *opaque)
501409e9f71SMark Cave-Ayland {
502409e9f71SMark Cave-Ayland GString *buf = opaque;
503409e9f71SMark Cave-Ayland
504409e9f71SMark Cave-Ayland if (object_dynamic_cast(obj, TYPE_MOS6522)) {
505409e9f71SMark Cave-Ayland MOS6522State *s = MOS6522(obj);
506409e9f71SMark Cave-Ayland int64_t now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
507409e9f71SMark Cave-Ayland uint16_t t1counter = get_counter(s, &s->timers[0]);
508409e9f71SMark Cave-Ayland uint16_t t2counter = get_counter(s, &s->timers[1]);
509409e9f71SMark Cave-Ayland
510409e9f71SMark Cave-Ayland g_string_append_printf(buf, "%s:\n", object_get_typename(obj));
511409e9f71SMark Cave-Ayland
512409e9f71SMark Cave-Ayland g_string_append_printf(buf, " Registers:\n");
513409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
514409e9f71SMark Cave-Ayland mos6522_reg_names[0], s->b);
515409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
516409e9f71SMark Cave-Ayland mos6522_reg_names[1], s->a);
517409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
518409e9f71SMark Cave-Ayland mos6522_reg_names[2], s->dirb);
519409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
520409e9f71SMark Cave-Ayland mos6522_reg_names[3], s->dira);
521409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
522409e9f71SMark Cave-Ayland mos6522_reg_names[4], t1counter & 0xff);
523409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
524409e9f71SMark Cave-Ayland mos6522_reg_names[5], t1counter >> 8);
525409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
526409e9f71SMark Cave-Ayland mos6522_reg_names[6],
527409e9f71SMark Cave-Ayland s->timers[0].latch & 0xff);
528409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
529409e9f71SMark Cave-Ayland mos6522_reg_names[7],
530409e9f71SMark Cave-Ayland s->timers[0].latch >> 8);
531409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
532409e9f71SMark Cave-Ayland mos6522_reg_names[8], t2counter & 0xff);
533409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
534409e9f71SMark Cave-Ayland mos6522_reg_names[9], t2counter >> 8);
535409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
536409e9f71SMark Cave-Ayland mos6522_reg_names[10], s->sr);
537409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
538409e9f71SMark Cave-Ayland mos6522_reg_names[11], s->acr);
539409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
540409e9f71SMark Cave-Ayland mos6522_reg_names[12], s->pcr);
541409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
542409e9f71SMark Cave-Ayland mos6522_reg_names[13], s->ifr);
543409e9f71SMark Cave-Ayland g_string_append_printf(buf, " %-*s: 0x%x\n", 4,
544409e9f71SMark Cave-Ayland mos6522_reg_names[14], s->ier);
545409e9f71SMark Cave-Ayland
546409e9f71SMark Cave-Ayland g_string_append_printf(buf, " Timers:\n");
547409e9f71SMark Cave-Ayland g_string_append_printf(buf, " Using current time now(ns)=%"PRId64
548409e9f71SMark Cave-Ayland "\n", now);
549409e9f71SMark Cave-Ayland g_string_append_printf(buf, " T1 freq(hz)=%"PRId64
550409e9f71SMark Cave-Ayland " mode=%s"
551409e9f71SMark Cave-Ayland " counter=0x%x"
552409e9f71SMark Cave-Ayland " latch=0x%x\n"
553409e9f71SMark Cave-Ayland " load_time(ns)=%"PRId64
554409e9f71SMark Cave-Ayland " next_irq_time(ns)=%"PRId64 "\n",
555409e9f71SMark Cave-Ayland s->timers[0].frequency,
556409e9f71SMark Cave-Ayland ((s->acr & T1MODE) == T1MODE_CONT) ? "continuous"
557409e9f71SMark Cave-Ayland : "one-shot",
558409e9f71SMark Cave-Ayland t1counter,
559409e9f71SMark Cave-Ayland s->timers[0].latch,
560409e9f71SMark Cave-Ayland s->timers[0].load_time,
561409e9f71SMark Cave-Ayland get_next_irq_time(s, &s->timers[0], now));
562409e9f71SMark Cave-Ayland g_string_append_printf(buf, " T2 freq(hz)=%"PRId64
563409e9f71SMark Cave-Ayland " mode=%s"
564409e9f71SMark Cave-Ayland " counter=0x%x"
565409e9f71SMark Cave-Ayland " latch=0x%x\n"
566409e9f71SMark Cave-Ayland " load_time(ns)=%"PRId64
567409e9f71SMark Cave-Ayland " next_irq_time(ns)=%"PRId64 "\n",
568409e9f71SMark Cave-Ayland s->timers[1].frequency,
569409e9f71SMark Cave-Ayland "one-shot",
570409e9f71SMark Cave-Ayland t2counter,
571409e9f71SMark Cave-Ayland s->timers[1].latch,
572409e9f71SMark Cave-Ayland s->timers[1].load_time,
573409e9f71SMark Cave-Ayland get_next_irq_time(s, &s->timers[1], now));
574409e9f71SMark Cave-Ayland }
575409e9f71SMark Cave-Ayland
576409e9f71SMark Cave-Ayland return 0;
577409e9f71SMark Cave-Ayland }
578409e9f71SMark Cave-Ayland
qmp_x_query_via(Error ** errp)579409e9f71SMark Cave-Ayland static HumanReadableText *qmp_x_query_via(Error **errp)
580409e9f71SMark Cave-Ayland {
581409e9f71SMark Cave-Ayland g_autoptr(GString) buf = g_string_new("");
582409e9f71SMark Cave-Ayland
583409e9f71SMark Cave-Ayland object_child_foreach_recursive(object_get_root(),
584409e9f71SMark Cave-Ayland qmp_x_query_via_foreach, buf);
585409e9f71SMark Cave-Ayland
586409e9f71SMark Cave-Ayland return human_readable_text_from_str(buf);
587409e9f71SMark Cave-Ayland }
588409e9f71SMark Cave-Ayland
hmp_info_via(Monitor * mon,const QDict * qdict)589409e9f71SMark Cave-Ayland void hmp_info_via(Monitor *mon, const QDict *qdict)
590409e9f71SMark Cave-Ayland {
591409e9f71SMark Cave-Ayland Error *err = NULL;
592409e9f71SMark Cave-Ayland g_autoptr(HumanReadableText) info = qmp_x_query_via(&err);
593409e9f71SMark Cave-Ayland
594409e9f71SMark Cave-Ayland if (hmp_handle_error(mon, err)) {
595409e9f71SMark Cave-Ayland return;
596409e9f71SMark Cave-Ayland }
597bf0c50d4SAlex Bennée monitor_puts(mon, info->human_readable_text);
598409e9f71SMark Cave-Ayland }
599409e9f71SMark Cave-Ayland
60051f233ecSMark Cave-Ayland static const MemoryRegionOps mos6522_ops = {
60151f233ecSMark Cave-Ayland .read = mos6522_read,
60251f233ecSMark Cave-Ayland .write = mos6522_write,
60351f233ecSMark Cave-Ayland .endianness = DEVICE_NATIVE_ENDIAN,
60451f233ecSMark Cave-Ayland .valid = {
60551f233ecSMark Cave-Ayland .min_access_size = 1,
60651f233ecSMark Cave-Ayland .max_access_size = 1,
60751f233ecSMark Cave-Ayland },
60851f233ecSMark Cave-Ayland };
60951f233ecSMark Cave-Ayland
61051f233ecSMark Cave-Ayland static const VMStateDescription vmstate_mos6522_timer = {
61151f233ecSMark Cave-Ayland .name = "mos6522_timer",
61251f233ecSMark Cave-Ayland .version_id = 0,
61351f233ecSMark Cave-Ayland .minimum_version_id = 0,
614e4ea952fSRichard Henderson .fields = (const VMStateField[]) {
61551f233ecSMark Cave-Ayland VMSTATE_UINT16(latch, MOS6522Timer),
61651f233ecSMark Cave-Ayland VMSTATE_UINT16(counter_value, MOS6522Timer),
61751f233ecSMark Cave-Ayland VMSTATE_INT64(load_time, MOS6522Timer),
61851f233ecSMark Cave-Ayland VMSTATE_INT64(next_irq_time, MOS6522Timer),
6193431bdf5SMark Cave-Ayland VMSTATE_TIMER_PTR(timer, MOS6522Timer),
62051f233ecSMark Cave-Ayland VMSTATE_END_OF_LIST()
62151f233ecSMark Cave-Ayland }
62251f233ecSMark Cave-Ayland };
62351f233ecSMark Cave-Ayland
6242e3e5c7eSMark Cave-Ayland const VMStateDescription vmstate_mos6522 = {
62551f233ecSMark Cave-Ayland .name = "mos6522",
626d4454e41SMark Cave-Ayland .version_id = 1,
627d4454e41SMark Cave-Ayland .minimum_version_id = 1,
628e4ea952fSRichard Henderson .fields = (const VMStateField[]) {
62951f233ecSMark Cave-Ayland VMSTATE_UINT8(a, MOS6522State),
63051f233ecSMark Cave-Ayland VMSTATE_UINT8(b, MOS6522State),
63151f233ecSMark Cave-Ayland VMSTATE_UINT8(dira, MOS6522State),
63251f233ecSMark Cave-Ayland VMSTATE_UINT8(dirb, MOS6522State),
63351f233ecSMark Cave-Ayland VMSTATE_UINT8(sr, MOS6522State),
63451f233ecSMark Cave-Ayland VMSTATE_UINT8(acr, MOS6522State),
63551f233ecSMark Cave-Ayland VMSTATE_UINT8(pcr, MOS6522State),
63651f233ecSMark Cave-Ayland VMSTATE_UINT8(ifr, MOS6522State),
63751f233ecSMark Cave-Ayland VMSTATE_UINT8(ier, MOS6522State),
638d4454e41SMark Cave-Ayland VMSTATE_UINT8(last_irq_levels, MOS6522State),
63972ee08cfSMark Cave-Ayland VMSTATE_STRUCT_ARRAY(timers, MOS6522State, 2, 0,
64051f233ecSMark Cave-Ayland vmstate_mos6522_timer, MOS6522Timer),
64151f233ecSMark Cave-Ayland VMSTATE_END_OF_LIST()
64251f233ecSMark Cave-Ayland }
64351f233ecSMark Cave-Ayland };
64451f233ecSMark Cave-Ayland
mos6522_reset_hold(Object * obj,ResetType type)645*ad80e367SPeter Maydell static void mos6522_reset_hold(Object *obj, ResetType type)
64651f233ecSMark Cave-Ayland {
6478bdaed0fSPeter Maydell MOS6522State *s = MOS6522(obj);
64851f233ecSMark Cave-Ayland
64951f233ecSMark Cave-Ayland s->b = 0;
65051f233ecSMark Cave-Ayland s->a = 0;
65151f233ecSMark Cave-Ayland s->dirb = 0xff;
65251f233ecSMark Cave-Ayland s->dira = 0;
65351f233ecSMark Cave-Ayland s->sr = 0;
65451f233ecSMark Cave-Ayland s->acr = 0;
65551f233ecSMark Cave-Ayland s->pcr = 0;
65651f233ecSMark Cave-Ayland s->ifr = 0;
65751f233ecSMark Cave-Ayland s->ier = 0;
65851f233ecSMark Cave-Ayland /* s->ier = T1_INT | SR_INT; */
65951f233ecSMark Cave-Ayland
660d638fd5cSMark Cave-Ayland s->timers[0].frequency = s->frequency;
66151f233ecSMark Cave-Ayland s->timers[0].latch = 0xffff;
66251f233ecSMark Cave-Ayland set_counter(s, &s->timers[0], 0xffff);
663cd8843ffSLaurent Vivier timer_del(s->timers[0].timer);
66451f233ecSMark Cave-Ayland
66551f233ecSMark Cave-Ayland s->timers[1].frequency = s->frequency;
666d638fd5cSMark Cave-Ayland s->timers[1].latch = 0xffff;
667cd8843ffSLaurent Vivier timer_del(s->timers[1].timer);
66851f233ecSMark Cave-Ayland }
66951f233ecSMark Cave-Ayland
mos6522_init(Object * obj)67051f233ecSMark Cave-Ayland static void mos6522_init(Object *obj)
67151f233ecSMark Cave-Ayland {
67251f233ecSMark Cave-Ayland SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
67351f233ecSMark Cave-Ayland MOS6522State *s = MOS6522(obj);
67451f233ecSMark Cave-Ayland int i;
67551f233ecSMark Cave-Ayland
6766c726698SMark Cave-Ayland memory_region_init_io(&s->mem, obj, &mos6522_ops, s, "mos6522",
6776c726698SMark Cave-Ayland MOS6522_NUM_REGS);
67851f233ecSMark Cave-Ayland sysbus_init_mmio(sbd, &s->mem);
67951f233ecSMark Cave-Ayland sysbus_init_irq(sbd, &s->irq);
68051f233ecSMark Cave-Ayland
68151f233ecSMark Cave-Ayland for (i = 0; i < ARRAY_SIZE(s->timers); i++) {
68251f233ecSMark Cave-Ayland s->timers[i].index = i;
68351f233ecSMark Cave-Ayland }
68451f233ecSMark Cave-Ayland
68551f233ecSMark Cave-Ayland s->timers[0].timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, mos6522_timer1, s);
68651f233ecSMark Cave-Ayland s->timers[1].timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, mos6522_timer2, s);
687ebe5bca2SMark Cave-Ayland
688ebe5bca2SMark Cave-Ayland qdev_init_gpio_in(DEVICE(obj), mos6522_set_irq, VIA_NUM_INTS);
68951f233ecSMark Cave-Ayland }
69051f233ecSMark Cave-Ayland
mos6522_finalize(Object * obj)6913d64fddeSGan Qixin static void mos6522_finalize(Object *obj)
6923d64fddeSGan Qixin {
6933d64fddeSGan Qixin MOS6522State *s = MOS6522(obj);
6943d64fddeSGan Qixin
6953d64fddeSGan Qixin timer_free(s->timers[0].timer);
6963d64fddeSGan Qixin timer_free(s->timers[1].timer);
6973d64fddeSGan Qixin }
6983d64fddeSGan Qixin
69951f233ecSMark Cave-Ayland static Property mos6522_properties[] = {
70051f233ecSMark Cave-Ayland DEFINE_PROP_UINT64("frequency", MOS6522State, frequency, 0),
70151f233ecSMark Cave-Ayland DEFINE_PROP_END_OF_LIST()
70251f233ecSMark Cave-Ayland };
70351f233ecSMark Cave-Ayland
mos6522_class_init(ObjectClass * oc,void * data)70451f233ecSMark Cave-Ayland static void mos6522_class_init(ObjectClass *oc, void *data)
70551f233ecSMark Cave-Ayland {
70651f233ecSMark Cave-Ayland DeviceClass *dc = DEVICE_CLASS(oc);
7078bdaed0fSPeter Maydell ResettableClass *rc = RESETTABLE_CLASS(oc);
7089db70dacSEduardo Habkost MOS6522DeviceClass *mdc = MOS6522_CLASS(oc);
70951f233ecSMark Cave-Ayland
7108bdaed0fSPeter Maydell rc->phases.hold = mos6522_reset_hold;
71151f233ecSMark Cave-Ayland dc->vmsd = &vmstate_mos6522;
7124f67d30bSMarc-André Lureau device_class_set_props(dc, mos6522_properties);
71351f233ecSMark Cave-Ayland mdc->portB_write = mos6522_portB_write;
71451f233ecSMark Cave-Ayland mdc->portA_write = mos6522_portA_write;
71551f233ecSMark Cave-Ayland mdc->get_timer1_counter_value = mos6522_get_counter_value;
71651f233ecSMark Cave-Ayland mdc->get_timer2_counter_value = mos6522_get_counter_value;
71751f233ecSMark Cave-Ayland mdc->get_timer1_load_time = mos6522_get_load_time;
71851f233ecSMark Cave-Ayland mdc->get_timer2_load_time = mos6522_get_load_time;
71951f233ecSMark Cave-Ayland }
72051f233ecSMark Cave-Ayland
72151f233ecSMark Cave-Ayland static const TypeInfo mos6522_type_info = {
72251f233ecSMark Cave-Ayland .name = TYPE_MOS6522,
72351f233ecSMark Cave-Ayland .parent = TYPE_SYS_BUS_DEVICE,
72451f233ecSMark Cave-Ayland .instance_size = sizeof(MOS6522State),
72551f233ecSMark Cave-Ayland .instance_init = mos6522_init,
7263d64fddeSGan Qixin .instance_finalize = mos6522_finalize,
72751f233ecSMark Cave-Ayland .abstract = true,
72851f233ecSMark Cave-Ayland .class_size = sizeof(MOS6522DeviceClass),
72951f233ecSMark Cave-Ayland .class_init = mos6522_class_init,
73051f233ecSMark Cave-Ayland };
73151f233ecSMark Cave-Ayland
mos6522_register_types(void)73251f233ecSMark Cave-Ayland static void mos6522_register_types(void)
73351f233ecSMark Cave-Ayland {
73451f233ecSMark Cave-Ayland type_register_static(&mos6522_type_info);
73551f233ecSMark Cave-Ayland }
73651f233ecSMark Cave-Ayland
73751f233ecSMark Cave-Ayland type_init(mos6522_register_types)
738