xref: /qemu/hw/misc/macio/pmu.c (revision a27bd6c779badb8d76e4430d810ef710a1b98f4e)
1d811d61fSMark Cave-Ayland /*
2d811d61fSMark Cave-Ayland  * QEMU PowerMac PMU device support
3d811d61fSMark Cave-Ayland  *
4d811d61fSMark Cave-Ayland  * Copyright (c) 2016 Benjamin Herrenschmidt, IBM Corp.
5d811d61fSMark Cave-Ayland  * Copyright (c) 2018 Mark Cave-Ayland
6d811d61fSMark Cave-Ayland  *
7d811d61fSMark Cave-Ayland  * Based on the CUDA device by:
8d811d61fSMark Cave-Ayland  *
9d811d61fSMark Cave-Ayland  * Copyright (c) 2004-2007 Fabrice Bellard
10d811d61fSMark Cave-Ayland  * Copyright (c) 2007 Jocelyn Mayer
11d811d61fSMark Cave-Ayland  *
12d811d61fSMark Cave-Ayland  * Permission is hereby granted, free of charge, to any person obtaining a copy
13d811d61fSMark Cave-Ayland  * of this software and associated documentation files (the "Software"), to deal
14d811d61fSMark Cave-Ayland  * in the Software without restriction, including without limitation the rights
15d811d61fSMark Cave-Ayland  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
16d811d61fSMark Cave-Ayland  * copies of the Software, and to permit persons to whom the Software is
17d811d61fSMark Cave-Ayland  * furnished to do so, subject to the following conditions:
18d811d61fSMark Cave-Ayland  *
19d811d61fSMark Cave-Ayland  * The above copyright notice and this permission notice shall be included in
20d811d61fSMark Cave-Ayland  * all copies or substantial portions of the Software.
21d811d61fSMark Cave-Ayland  *
22d811d61fSMark Cave-Ayland  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
23d811d61fSMark Cave-Ayland  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
24d811d61fSMark Cave-Ayland  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
25d811d61fSMark Cave-Ayland  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
26d811d61fSMark Cave-Ayland  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
27d811d61fSMark Cave-Ayland  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
28d811d61fSMark Cave-Ayland  * THE SOFTWARE.
29d811d61fSMark Cave-Ayland  */
30d811d61fSMark Cave-Ayland 
31d811d61fSMark Cave-Ayland #include "qemu/osdep.h"
32a8d25326SMarkus Armbruster #include "qemu-common.h"
33d811d61fSMark Cave-Ayland #include "hw/ppc/mac.h"
34*a27bd6c7SMarkus Armbruster #include "hw/qdev-properties.h"
35d6454270SMarkus Armbruster #include "migration/vmstate.h"
36d811d61fSMark Cave-Ayland #include "hw/input/adb.h"
3764552b6bSMarkus Armbruster #include "hw/irq.h"
38d811d61fSMark Cave-Ayland #include "hw/misc/mos6522.h"
39d811d61fSMark Cave-Ayland #include "hw/misc/macio/gpio.h"
40d811d61fSMark Cave-Ayland #include "hw/misc/macio/pmu.h"
41d811d61fSMark Cave-Ayland #include "qemu/timer.h"
42d811d61fSMark Cave-Ayland #include "sysemu/sysemu.h"
43d811d61fSMark Cave-Ayland #include "qemu/cutils.h"
44d811d61fSMark Cave-Ayland #include "qemu/log.h"
450b8fa32fSMarkus Armbruster #include "qemu/module.h"
46d811d61fSMark Cave-Ayland #include "trace.h"
47d811d61fSMark Cave-Ayland 
48d811d61fSMark Cave-Ayland 
49d811d61fSMark Cave-Ayland /* Bits in B data register: all active low */
50d811d61fSMark Cave-Ayland #define TACK    0x08    /* Transfer request (input) */
51d811d61fSMark Cave-Ayland #define TREQ    0x10    /* Transfer acknowledge (output) */
52d811d61fSMark Cave-Ayland 
53d811d61fSMark Cave-Ayland /* PMU returns time_t's offset from Jan 1, 1904, not 1970 */
54d811d61fSMark Cave-Ayland #define RTC_OFFSET                      2082844800
55d811d61fSMark Cave-Ayland 
56d811d61fSMark Cave-Ayland #define VIA_TIMER_FREQ (4700000 / 6)
57d811d61fSMark Cave-Ayland 
58d811d61fSMark Cave-Ayland static void via_update_irq(PMUState *s)
59d811d61fSMark Cave-Ayland {
60d811d61fSMark Cave-Ayland     MOS6522PMUState *mps = MOS6522_PMU(&s->mos6522_pmu);
61d811d61fSMark Cave-Ayland     MOS6522State *ms = MOS6522(mps);
62d811d61fSMark Cave-Ayland 
63d811d61fSMark Cave-Ayland     bool new_state = !!(ms->ifr & ms->ier & (SR_INT | T1_INT | T2_INT));
64d811d61fSMark Cave-Ayland 
65d811d61fSMark Cave-Ayland     if (new_state != s->via_irq_state) {
66d811d61fSMark Cave-Ayland         s->via_irq_state = new_state;
67d811d61fSMark Cave-Ayland         qemu_set_irq(s->via_irq, new_state);
68d811d61fSMark Cave-Ayland     }
69d811d61fSMark Cave-Ayland }
70d811d61fSMark Cave-Ayland 
71d811d61fSMark Cave-Ayland static void via_set_sr_int(void *opaque)
72d811d61fSMark Cave-Ayland {
73d811d61fSMark Cave-Ayland     PMUState *s = opaque;
74d811d61fSMark Cave-Ayland     MOS6522PMUState *mps = MOS6522_PMU(&s->mos6522_pmu);
75d811d61fSMark Cave-Ayland     MOS6522State *ms = MOS6522(mps);
76d811d61fSMark Cave-Ayland     MOS6522DeviceClass *mdc = MOS6522_DEVICE_GET_CLASS(ms);
77d811d61fSMark Cave-Ayland 
78d811d61fSMark Cave-Ayland     mdc->set_sr_int(ms);
79d811d61fSMark Cave-Ayland }
80d811d61fSMark Cave-Ayland 
81d811d61fSMark Cave-Ayland static void pmu_update_extirq(PMUState *s)
82d811d61fSMark Cave-Ayland {
83d811d61fSMark Cave-Ayland     if ((s->intbits & s->intmask) != 0) {
84d811d61fSMark Cave-Ayland         macio_set_gpio(s->gpio, 1, false);
85d811d61fSMark Cave-Ayland     } else {
86d811d61fSMark Cave-Ayland         macio_set_gpio(s->gpio, 1, true);
87d811d61fSMark Cave-Ayland     }
88d811d61fSMark Cave-Ayland }
89d811d61fSMark Cave-Ayland 
90d811d61fSMark Cave-Ayland static void pmu_adb_poll(void *opaque)
91d811d61fSMark Cave-Ayland {
92d811d61fSMark Cave-Ayland     PMUState *s = opaque;
93d811d61fSMark Cave-Ayland     int olen;
94d811d61fSMark Cave-Ayland 
95d811d61fSMark Cave-Ayland     if (!(s->intbits & PMU_INT_ADB)) {
96d811d61fSMark Cave-Ayland         olen = adb_poll(&s->adb_bus, s->adb_reply, s->adb_poll_mask);
97d811d61fSMark Cave-Ayland         trace_pmu_adb_poll(olen);
98d811d61fSMark Cave-Ayland 
99d811d61fSMark Cave-Ayland         if (olen > 0) {
100d811d61fSMark Cave-Ayland             s->adb_reply_size = olen;
101d811d61fSMark Cave-Ayland             s->intbits |= PMU_INT_ADB | PMU_INT_ADB_AUTO;
102d811d61fSMark Cave-Ayland             pmu_update_extirq(s);
103d811d61fSMark Cave-Ayland         }
104d811d61fSMark Cave-Ayland     }
105d811d61fSMark Cave-Ayland 
106d811d61fSMark Cave-Ayland     timer_mod(s->adb_poll_timer,
107d811d61fSMark Cave-Ayland               qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + 30);
108d811d61fSMark Cave-Ayland }
109d811d61fSMark Cave-Ayland 
110d811d61fSMark Cave-Ayland static void pmu_one_sec_timer(void *opaque)
111d811d61fSMark Cave-Ayland {
112d811d61fSMark Cave-Ayland     PMUState *s = opaque;
113d811d61fSMark Cave-Ayland 
114d811d61fSMark Cave-Ayland     trace_pmu_one_sec_timer();
115d811d61fSMark Cave-Ayland 
116d811d61fSMark Cave-Ayland     s->intbits |= PMU_INT_TICK;
117d811d61fSMark Cave-Ayland     pmu_update_extirq(s);
118d811d61fSMark Cave-Ayland     s->one_sec_target += 1000;
119d811d61fSMark Cave-Ayland 
120d811d61fSMark Cave-Ayland     timer_mod(s->one_sec_timer, s->one_sec_target);
121d811d61fSMark Cave-Ayland }
122d811d61fSMark Cave-Ayland 
123d811d61fSMark Cave-Ayland static void pmu_cmd_int_ack(PMUState *s,
124d811d61fSMark Cave-Ayland                             const uint8_t *in_data, uint8_t in_len,
125d811d61fSMark Cave-Ayland                             uint8_t *out_data, uint8_t *out_len)
126d811d61fSMark Cave-Ayland {
127d811d61fSMark Cave-Ayland     if (in_len != 0) {
128d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
129d811d61fSMark Cave-Ayland                       "PMU: INT_ACK command, invalid len: %d want: 0\n",
130d811d61fSMark Cave-Ayland                       in_len);
131d811d61fSMark Cave-Ayland         return;
132d811d61fSMark Cave-Ayland     }
133d811d61fSMark Cave-Ayland 
134d811d61fSMark Cave-Ayland     /* Make appropriate reply packet */
135d811d61fSMark Cave-Ayland     if (s->intbits & PMU_INT_ADB) {
136d811d61fSMark Cave-Ayland         if (!s->adb_reply_size) {
137d811d61fSMark Cave-Ayland             qemu_log_mask(LOG_GUEST_ERROR,
138d811d61fSMark Cave-Ayland                           "Odd, PMU_INT_ADB set with no reply in buffer\n");
139d811d61fSMark Cave-Ayland         }
140d811d61fSMark Cave-Ayland 
141d811d61fSMark Cave-Ayland         memcpy(out_data + 1, s->adb_reply, s->adb_reply_size);
142d811d61fSMark Cave-Ayland         out_data[0] = s->intbits & (PMU_INT_ADB | PMU_INT_ADB_AUTO);
143d811d61fSMark Cave-Ayland         *out_len = s->adb_reply_size + 1;
144d811d61fSMark Cave-Ayland         s->intbits &= ~(PMU_INT_ADB | PMU_INT_ADB_AUTO);
145d811d61fSMark Cave-Ayland         s->adb_reply_size = 0;
146d811d61fSMark Cave-Ayland     } else {
147d811d61fSMark Cave-Ayland         out_data[0] = s->intbits;
148d811d61fSMark Cave-Ayland         s->intbits = 0;
149d811d61fSMark Cave-Ayland         *out_len = 1;
150d811d61fSMark Cave-Ayland     }
151d811d61fSMark Cave-Ayland 
152d811d61fSMark Cave-Ayland     pmu_update_extirq(s);
153d811d61fSMark Cave-Ayland }
154d811d61fSMark Cave-Ayland 
155d811d61fSMark Cave-Ayland static void pmu_cmd_set_int_mask(PMUState *s,
156d811d61fSMark Cave-Ayland                                  const uint8_t *in_data, uint8_t in_len,
157d811d61fSMark Cave-Ayland                                  uint8_t *out_data, uint8_t *out_len)
158d811d61fSMark Cave-Ayland {
159d811d61fSMark Cave-Ayland     if (in_len != 1) {
160d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
161d811d61fSMark Cave-Ayland                       "PMU: SET_INT_MASK command, invalid len: %d want: 1\n",
162d811d61fSMark Cave-Ayland                       in_len);
163d811d61fSMark Cave-Ayland         return;
164d811d61fSMark Cave-Ayland     }
165d811d61fSMark Cave-Ayland 
166d811d61fSMark Cave-Ayland     trace_pmu_cmd_set_int_mask(s->intmask);
167d811d61fSMark Cave-Ayland     s->intmask = in_data[0];
168d811d61fSMark Cave-Ayland 
169d811d61fSMark Cave-Ayland     pmu_update_extirq(s);
170d811d61fSMark Cave-Ayland }
171d811d61fSMark Cave-Ayland 
172d811d61fSMark Cave-Ayland static void pmu_cmd_set_adb_autopoll(PMUState *s, uint16_t mask)
173d811d61fSMark Cave-Ayland {
174d811d61fSMark Cave-Ayland     trace_pmu_cmd_set_adb_autopoll(mask);
175d811d61fSMark Cave-Ayland 
176d811d61fSMark Cave-Ayland     if (s->autopoll_mask == mask) {
177d811d61fSMark Cave-Ayland         return;
178d811d61fSMark Cave-Ayland     }
179d811d61fSMark Cave-Ayland 
180d811d61fSMark Cave-Ayland     s->autopoll_mask = mask;
181d811d61fSMark Cave-Ayland     if (mask) {
182d811d61fSMark Cave-Ayland         timer_mod(s->adb_poll_timer,
183d811d61fSMark Cave-Ayland                   qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + 30);
184d811d61fSMark Cave-Ayland     } else {
185d811d61fSMark Cave-Ayland         timer_del(s->adb_poll_timer);
186d811d61fSMark Cave-Ayland     }
187d811d61fSMark Cave-Ayland }
188d811d61fSMark Cave-Ayland 
189d811d61fSMark Cave-Ayland static void pmu_cmd_adb(PMUState *s,
190d811d61fSMark Cave-Ayland                         const uint8_t *in_data, uint8_t in_len,
191d811d61fSMark Cave-Ayland                         uint8_t *out_data, uint8_t *out_len)
192d811d61fSMark Cave-Ayland {
193d811d61fSMark Cave-Ayland     int len, adblen;
194d811d61fSMark Cave-Ayland     uint8_t adb_cmd[255];
195d811d61fSMark Cave-Ayland 
196d811d61fSMark Cave-Ayland     if (in_len < 2) {
197d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
198d811d61fSMark Cave-Ayland                       "PMU: ADB PACKET, invalid len: %d want at least 2\n",
199d811d61fSMark Cave-Ayland                       in_len);
200d811d61fSMark Cave-Ayland         return;
201d811d61fSMark Cave-Ayland     }
202d811d61fSMark Cave-Ayland 
203d811d61fSMark Cave-Ayland     *out_len = 0;
204d811d61fSMark Cave-Ayland 
205d811d61fSMark Cave-Ayland     if (!s->has_adb) {
206d811d61fSMark Cave-Ayland         trace_pmu_cmd_adb_nobus();
207d811d61fSMark Cave-Ayland         return;
208d811d61fSMark Cave-Ayland     }
209d811d61fSMark Cave-Ayland 
210d811d61fSMark Cave-Ayland     /* Set autopoll is a special form of the command */
211d811d61fSMark Cave-Ayland     if (in_data[0] == 0 && in_data[1] == 0x86) {
212d811d61fSMark Cave-Ayland         uint16_t mask = in_data[2];
213d811d61fSMark Cave-Ayland         mask = (mask << 8) | in_data[3];
214d811d61fSMark Cave-Ayland         if (in_len != 4) {
215d811d61fSMark Cave-Ayland             qemu_log_mask(LOG_GUEST_ERROR,
216d811d61fSMark Cave-Ayland                           "PMU: ADB Autopoll requires 4 bytes, got %d\n",
217d811d61fSMark Cave-Ayland                           in_len);
218d811d61fSMark Cave-Ayland             return;
219d811d61fSMark Cave-Ayland         }
220d811d61fSMark Cave-Ayland 
221d811d61fSMark Cave-Ayland         pmu_cmd_set_adb_autopoll(s, mask);
222d811d61fSMark Cave-Ayland         return;
223d811d61fSMark Cave-Ayland     }
224d811d61fSMark Cave-Ayland 
225d811d61fSMark Cave-Ayland     trace_pmu_cmd_adb_request(in_len, in_data[0], in_data[1], in_data[2],
226d811d61fSMark Cave-Ayland                               in_data[3], in_data[4]);
227d811d61fSMark Cave-Ayland 
228d811d61fSMark Cave-Ayland     *out_len = 0;
229d811d61fSMark Cave-Ayland 
230d811d61fSMark Cave-Ayland     /* Check ADB len */
231d811d61fSMark Cave-Ayland     adblen = in_data[2];
232d811d61fSMark Cave-Ayland     if (adblen > (in_len - 3)) {
233d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
234d811d61fSMark Cave-Ayland                       "PMU: ADB len is %d > %d (in_len -3)...erroring\n",
235d811d61fSMark Cave-Ayland                       adblen, in_len - 3);
236d811d61fSMark Cave-Ayland         len = -1;
237d811d61fSMark Cave-Ayland     } else if (adblen > 252) {
238d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR, "PMU: ADB command too big!\n");
239d811d61fSMark Cave-Ayland         len = -1;
240d811d61fSMark Cave-Ayland     } else {
241d811d61fSMark Cave-Ayland         /* Format command */
242d811d61fSMark Cave-Ayland         adb_cmd[0] = in_data[0];
243d811d61fSMark Cave-Ayland         memcpy(&adb_cmd[1], &in_data[3], in_len - 3);
244d811d61fSMark Cave-Ayland         len = adb_request(&s->adb_bus, s->adb_reply + 2, adb_cmd, in_len - 2);
245d811d61fSMark Cave-Ayland 
246d811d61fSMark Cave-Ayland         trace_pmu_cmd_adb_reply(len);
247d811d61fSMark Cave-Ayland     }
248d811d61fSMark Cave-Ayland 
249d811d61fSMark Cave-Ayland     if (len > 0) {
250d811d61fSMark Cave-Ayland         /* XXX Check this */
251d811d61fSMark Cave-Ayland         s->adb_reply_size = len + 2;
252d811d61fSMark Cave-Ayland         s->adb_reply[0] = 0x01;
253d811d61fSMark Cave-Ayland         s->adb_reply[1] = len;
254d811d61fSMark Cave-Ayland     } else {
255d811d61fSMark Cave-Ayland         /* XXX Check this */
256d811d61fSMark Cave-Ayland         s->adb_reply_size = 1;
257d811d61fSMark Cave-Ayland         s->adb_reply[0] = 0x00;
258d811d61fSMark Cave-Ayland     }
259d811d61fSMark Cave-Ayland 
260d811d61fSMark Cave-Ayland     s->intbits |= PMU_INT_ADB;
261d811d61fSMark Cave-Ayland     pmu_update_extirq(s);
262d811d61fSMark Cave-Ayland }
263d811d61fSMark Cave-Ayland 
264d811d61fSMark Cave-Ayland static void pmu_cmd_adb_poll_off(PMUState *s,
265d811d61fSMark Cave-Ayland                                  const uint8_t *in_data, uint8_t in_len,
266d811d61fSMark Cave-Ayland                                  uint8_t *out_data, uint8_t *out_len)
267d811d61fSMark Cave-Ayland {
268d811d61fSMark Cave-Ayland     if (in_len != 0) {
269d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
270d811d61fSMark Cave-Ayland                       "PMU: ADB POLL OFF command, invalid len: %d want: 0\n",
271d811d61fSMark Cave-Ayland                       in_len);
272d811d61fSMark Cave-Ayland         return;
273d811d61fSMark Cave-Ayland     }
274d811d61fSMark Cave-Ayland 
275d811d61fSMark Cave-Ayland     if (s->has_adb && s->autopoll_mask) {
276d811d61fSMark Cave-Ayland         timer_del(s->adb_poll_timer);
277d811d61fSMark Cave-Ayland         s->autopoll_mask = false;
278d811d61fSMark Cave-Ayland     }
279d811d61fSMark Cave-Ayland }
280d811d61fSMark Cave-Ayland 
281d811d61fSMark Cave-Ayland static void pmu_cmd_shutdown(PMUState *s,
282d811d61fSMark Cave-Ayland                              const uint8_t *in_data, uint8_t in_len,
283d811d61fSMark Cave-Ayland                              uint8_t *out_data, uint8_t *out_len)
284d811d61fSMark Cave-Ayland {
285d811d61fSMark Cave-Ayland     if (in_len != 4) {
286d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
287d811d61fSMark Cave-Ayland                       "PMU: SHUTDOWN command, invalid len: %d want: 4\n",
288d811d61fSMark Cave-Ayland                       in_len);
289d811d61fSMark Cave-Ayland         return;
290d811d61fSMark Cave-Ayland     }
291d811d61fSMark Cave-Ayland 
292d811d61fSMark Cave-Ayland     *out_len = 1;
293d811d61fSMark Cave-Ayland     out_data[0] = 0;
294d811d61fSMark Cave-Ayland 
295d811d61fSMark Cave-Ayland     if (in_data[0] != 'M' || in_data[1] != 'A' || in_data[2] != 'T' ||
296d811d61fSMark Cave-Ayland         in_data[3] != 'T') {
297d811d61fSMark Cave-Ayland 
298d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
299d811d61fSMark Cave-Ayland                       "PMU: SHUTDOWN command, Bad MATT signature\n");
300d811d61fSMark Cave-Ayland         return;
301d811d61fSMark Cave-Ayland     }
302d811d61fSMark Cave-Ayland 
303d811d61fSMark Cave-Ayland     qemu_system_shutdown_request(SHUTDOWN_CAUSE_GUEST_SHUTDOWN);
304d811d61fSMark Cave-Ayland }
305d811d61fSMark Cave-Ayland 
306d811d61fSMark Cave-Ayland static void pmu_cmd_reset(PMUState *s,
307d811d61fSMark Cave-Ayland                           const uint8_t *in_data, uint8_t in_len,
308d811d61fSMark Cave-Ayland                           uint8_t *out_data, uint8_t *out_len)
309d811d61fSMark Cave-Ayland {
310d811d61fSMark Cave-Ayland     if (in_len != 0) {
311d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
312d811d61fSMark Cave-Ayland                       "PMU: RESET command, invalid len: %d want: 0\n",
313d811d61fSMark Cave-Ayland                       in_len);
314d811d61fSMark Cave-Ayland         return;
315d811d61fSMark Cave-Ayland     }
316d811d61fSMark Cave-Ayland 
317d811d61fSMark Cave-Ayland     qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
318d811d61fSMark Cave-Ayland }
319d811d61fSMark Cave-Ayland 
320d811d61fSMark Cave-Ayland static void pmu_cmd_get_rtc(PMUState *s,
321d811d61fSMark Cave-Ayland                             const uint8_t *in_data, uint8_t in_len,
322d811d61fSMark Cave-Ayland                             uint8_t *out_data, uint8_t *out_len)
323d811d61fSMark Cave-Ayland {
324d811d61fSMark Cave-Ayland     uint32_t ti;
325d811d61fSMark Cave-Ayland 
326d811d61fSMark Cave-Ayland     if (in_len != 0) {
327d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
328d811d61fSMark Cave-Ayland                       "PMU: GET_RTC command, invalid len: %d want: 0\n",
329d811d61fSMark Cave-Ayland                       in_len);
330d811d61fSMark Cave-Ayland         return;
331d811d61fSMark Cave-Ayland     }
332d811d61fSMark Cave-Ayland 
333d811d61fSMark Cave-Ayland     ti = s->tick_offset + (qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL)
334d811d61fSMark Cave-Ayland                            / NANOSECONDS_PER_SECOND);
335d811d61fSMark Cave-Ayland     out_data[0] = ti >> 24;
336d811d61fSMark Cave-Ayland     out_data[1] = ti >> 16;
337d811d61fSMark Cave-Ayland     out_data[2] = ti >> 8;
338d811d61fSMark Cave-Ayland     out_data[3] = ti;
339d811d61fSMark Cave-Ayland     *out_len = 4;
340d811d61fSMark Cave-Ayland }
341d811d61fSMark Cave-Ayland 
342d811d61fSMark Cave-Ayland static void pmu_cmd_set_rtc(PMUState *s,
343d811d61fSMark Cave-Ayland                             const uint8_t *in_data, uint8_t in_len,
344d811d61fSMark Cave-Ayland                             uint8_t *out_data, uint8_t *out_len)
345d811d61fSMark Cave-Ayland {
346d811d61fSMark Cave-Ayland     uint32_t ti;
347d811d61fSMark Cave-Ayland 
348d811d61fSMark Cave-Ayland     if (in_len != 4) {
349d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
350d811d61fSMark Cave-Ayland                       "PMU: SET_RTC command, invalid len: %d want: 4\n",
351d811d61fSMark Cave-Ayland                       in_len);
352d811d61fSMark Cave-Ayland         return;
353d811d61fSMark Cave-Ayland     }
354d811d61fSMark Cave-Ayland 
355d811d61fSMark Cave-Ayland     ti = (((uint32_t)in_data[0]) << 24) + (((uint32_t)in_data[1]) << 16)
356d811d61fSMark Cave-Ayland          + (((uint32_t)in_data[2]) << 8) + in_data[3];
357d811d61fSMark Cave-Ayland 
358d811d61fSMark Cave-Ayland     s->tick_offset = ti - (qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL)
359d811d61fSMark Cave-Ayland                            / NANOSECONDS_PER_SECOND);
360d811d61fSMark Cave-Ayland }
361d811d61fSMark Cave-Ayland 
362d811d61fSMark Cave-Ayland static void pmu_cmd_system_ready(PMUState *s,
363d811d61fSMark Cave-Ayland                                  const uint8_t *in_data, uint8_t in_len,
364d811d61fSMark Cave-Ayland                                  uint8_t *out_data, uint8_t *out_len)
365d811d61fSMark Cave-Ayland {
366d811d61fSMark Cave-Ayland     /* Do nothing */
367d811d61fSMark Cave-Ayland }
368d811d61fSMark Cave-Ayland 
369d811d61fSMark Cave-Ayland static void pmu_cmd_get_version(PMUState *s,
370d811d61fSMark Cave-Ayland                                 const uint8_t *in_data, uint8_t in_len,
371d811d61fSMark Cave-Ayland                                 uint8_t *out_data, uint8_t *out_len)
372d811d61fSMark Cave-Ayland {
373d811d61fSMark Cave-Ayland     *out_len = 1;
374d811d61fSMark Cave-Ayland     *out_data = 1; /* ??? Check what Apple does */
375d811d61fSMark Cave-Ayland }
376d811d61fSMark Cave-Ayland 
377d811d61fSMark Cave-Ayland static void pmu_cmd_power_events(PMUState *s,
378d811d61fSMark Cave-Ayland                                  const uint8_t *in_data, uint8_t in_len,
379d811d61fSMark Cave-Ayland                                  uint8_t *out_data, uint8_t *out_len)
380d811d61fSMark Cave-Ayland {
381d811d61fSMark Cave-Ayland     if (in_len < 1) {
382d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
383d811d61fSMark Cave-Ayland                       "PMU: POWER EVENTS command, invalid len %d, want at least 1\n",
384d811d61fSMark Cave-Ayland                       in_len);
385d811d61fSMark Cave-Ayland         return;
386d811d61fSMark Cave-Ayland     }
387d811d61fSMark Cave-Ayland 
388d811d61fSMark Cave-Ayland     switch (in_data[0]) {
389d811d61fSMark Cave-Ayland     /* Dummies for now */
390d811d61fSMark Cave-Ayland     case PMU_PWR_GET_POWERUP_EVENTS:
391d811d61fSMark Cave-Ayland         *out_len = 2;
392d811d61fSMark Cave-Ayland         out_data[0] = 0;
393d811d61fSMark Cave-Ayland         out_data[1] = 0;
394d811d61fSMark Cave-Ayland         break;
395d811d61fSMark Cave-Ayland     case PMU_PWR_SET_POWERUP_EVENTS:
396d811d61fSMark Cave-Ayland     case PMU_PWR_CLR_POWERUP_EVENTS:
397d811d61fSMark Cave-Ayland         break;
398d811d61fSMark Cave-Ayland     case PMU_PWR_GET_WAKEUP_EVENTS:
399d811d61fSMark Cave-Ayland         *out_len = 2;
400d811d61fSMark Cave-Ayland         out_data[0] = 0;
401d811d61fSMark Cave-Ayland         out_data[1] = 0;
402d811d61fSMark Cave-Ayland         break;
403d811d61fSMark Cave-Ayland     case PMU_PWR_SET_WAKEUP_EVENTS:
404d811d61fSMark Cave-Ayland     case PMU_PWR_CLR_WAKEUP_EVENTS:
405d811d61fSMark Cave-Ayland         break;
406d811d61fSMark Cave-Ayland     default:
407d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
408d811d61fSMark Cave-Ayland                       "PMU: POWER EVENTS unknown subcommand 0x%02x\n",
409d811d61fSMark Cave-Ayland                       in_data[0]);
410d811d61fSMark Cave-Ayland     }
411d811d61fSMark Cave-Ayland }
412d811d61fSMark Cave-Ayland 
413d811d61fSMark Cave-Ayland static void pmu_cmd_get_cover(PMUState *s,
414d811d61fSMark Cave-Ayland                               const uint8_t *in_data, uint8_t in_len,
415d811d61fSMark Cave-Ayland                               uint8_t *out_data, uint8_t *out_len)
416d811d61fSMark Cave-Ayland {
417d811d61fSMark Cave-Ayland     /* Not 100% sure here, will have to check what a real Mac
418d811d61fSMark Cave-Ayland      * returns other than byte 0 bit 0 is LID closed on laptops
419d811d61fSMark Cave-Ayland      */
420d811d61fSMark Cave-Ayland     *out_len = 1;
421d811d61fSMark Cave-Ayland     *out_data = 0x00;
422d811d61fSMark Cave-Ayland }
423d811d61fSMark Cave-Ayland 
424d811d61fSMark Cave-Ayland static void pmu_cmd_download_status(PMUState *s,
425d811d61fSMark Cave-Ayland                                     const uint8_t *in_data, uint8_t in_len,
426d811d61fSMark Cave-Ayland                                     uint8_t *out_data, uint8_t *out_len)
427d811d61fSMark Cave-Ayland {
428d811d61fSMark Cave-Ayland     /* This has to do with PMU firmware updates as far as I can tell.
429d811d61fSMark Cave-Ayland      *
430d811d61fSMark Cave-Ayland      * We return 0x62 which is what OpenPMU expects
431d811d61fSMark Cave-Ayland      */
432d811d61fSMark Cave-Ayland     *out_len = 1;
433d811d61fSMark Cave-Ayland     *out_data = 0x62;
434d811d61fSMark Cave-Ayland }
435d811d61fSMark Cave-Ayland 
436d811d61fSMark Cave-Ayland static void pmu_cmd_read_pmu_ram(PMUState *s,
437d811d61fSMark Cave-Ayland                                  const uint8_t *in_data, uint8_t in_len,
438d811d61fSMark Cave-Ayland                                  uint8_t *out_data, uint8_t *out_len)
439d811d61fSMark Cave-Ayland {
440d811d61fSMark Cave-Ayland     if (in_len < 3) {
441d811d61fSMark Cave-Ayland         qemu_log_mask(LOG_GUEST_ERROR,
442d811d61fSMark Cave-Ayland                       "PMU: READ_PMU_RAM command, invalid len %d, expected 3\n",
443d811d61fSMark Cave-Ayland                       in_len);
444d811d61fSMark Cave-Ayland         return;
445d811d61fSMark Cave-Ayland     }
446d811d61fSMark Cave-Ayland 
447d811d61fSMark Cave-Ayland     qemu_log_mask(LOG_GUEST_ERROR,
448d811d61fSMark Cave-Ayland                   "PMU: Unsupported READ_PMU_RAM, args: %02x %02x %02x\n",
449d811d61fSMark Cave-Ayland                   in_data[0], in_data[1], in_data[2]);
450d811d61fSMark Cave-Ayland 
451d811d61fSMark Cave-Ayland     *out_len = 0;
452d811d61fSMark Cave-Ayland }
453d811d61fSMark Cave-Ayland 
454d811d61fSMark Cave-Ayland /* description of commands */
455d811d61fSMark Cave-Ayland typedef struct PMUCmdHandler {
456d811d61fSMark Cave-Ayland     uint8_t command;
457d811d61fSMark Cave-Ayland     const char *name;
458d811d61fSMark Cave-Ayland     void (*handler)(PMUState *s,
459d811d61fSMark Cave-Ayland                     const uint8_t *in_args, uint8_t in_len,
460d811d61fSMark Cave-Ayland                     uint8_t *out_args, uint8_t *out_len);
461d811d61fSMark Cave-Ayland } PMUCmdHandler;
462d811d61fSMark Cave-Ayland 
463d811d61fSMark Cave-Ayland static const PMUCmdHandler PMUCmdHandlers[] = {
464d811d61fSMark Cave-Ayland     { PMU_INT_ACK, "INT ACK", pmu_cmd_int_ack },
465d811d61fSMark Cave-Ayland     { PMU_SET_INTR_MASK, "SET INT MASK", pmu_cmd_set_int_mask },
466d811d61fSMark Cave-Ayland     { PMU_ADB_CMD, "ADB COMMAND", pmu_cmd_adb },
467d811d61fSMark Cave-Ayland     { PMU_ADB_POLL_OFF, "ADB POLL OFF", pmu_cmd_adb_poll_off },
468d811d61fSMark Cave-Ayland     { PMU_RESET, "REBOOT", pmu_cmd_reset },
469d811d61fSMark Cave-Ayland     { PMU_SHUTDOWN, "SHUTDOWN", pmu_cmd_shutdown },
470d811d61fSMark Cave-Ayland     { PMU_READ_RTC, "GET RTC", pmu_cmd_get_rtc },
471d811d61fSMark Cave-Ayland     { PMU_SET_RTC, "SET RTC", pmu_cmd_set_rtc },
472d811d61fSMark Cave-Ayland     { PMU_SYSTEM_READY, "SYSTEM READY", pmu_cmd_system_ready },
473d811d61fSMark Cave-Ayland     { PMU_GET_VERSION, "GET VERSION", pmu_cmd_get_version },
474d811d61fSMark Cave-Ayland     { PMU_POWER_EVENTS, "POWER EVENTS", pmu_cmd_power_events },
475d811d61fSMark Cave-Ayland     { PMU_GET_COVER, "GET_COVER", pmu_cmd_get_cover },
476d811d61fSMark Cave-Ayland     { PMU_DOWNLOAD_STATUS, "DOWNLOAD STATUS", pmu_cmd_download_status },
477d811d61fSMark Cave-Ayland     { PMU_READ_PMU_RAM, "READ PMGR RAM", pmu_cmd_read_pmu_ram },
478d811d61fSMark Cave-Ayland };
479d811d61fSMark Cave-Ayland 
480d811d61fSMark Cave-Ayland static void pmu_dispatch_cmd(PMUState *s)
481d811d61fSMark Cave-Ayland {
482d811d61fSMark Cave-Ayland     unsigned int i;
483d811d61fSMark Cave-Ayland 
484d811d61fSMark Cave-Ayland     /* No response by default */
485d811d61fSMark Cave-Ayland     s->cmd_rsp_sz = 0;
486d811d61fSMark Cave-Ayland 
487d811d61fSMark Cave-Ayland     for (i = 0; i < ARRAY_SIZE(PMUCmdHandlers); i++) {
488d811d61fSMark Cave-Ayland         const PMUCmdHandler *desc = &PMUCmdHandlers[i];
489d811d61fSMark Cave-Ayland 
490d811d61fSMark Cave-Ayland         if (desc->command != s->cmd) {
491d811d61fSMark Cave-Ayland             continue;
492d811d61fSMark Cave-Ayland         }
493d811d61fSMark Cave-Ayland 
494d811d61fSMark Cave-Ayland         trace_pmu_dispatch_cmd(desc->name);
495d811d61fSMark Cave-Ayland         desc->handler(s, s->cmd_buf, s->cmd_buf_pos,
496d811d61fSMark Cave-Ayland                       s->cmd_rsp, &s->cmd_rsp_sz);
497d811d61fSMark Cave-Ayland 
498d811d61fSMark Cave-Ayland         if (s->rsplen != -1 && s->rsplen != s->cmd_rsp_sz) {
499d811d61fSMark Cave-Ayland             trace_pmu_debug_protocol_string("QEMU internal cmd resp mismatch!");
500d811d61fSMark Cave-Ayland         } else {
501d811d61fSMark Cave-Ayland             trace_pmu_debug_protocol_resp_size(s->cmd_rsp_sz);
502d811d61fSMark Cave-Ayland         }
503d811d61fSMark Cave-Ayland 
504d811d61fSMark Cave-Ayland         return;
505d811d61fSMark Cave-Ayland     }
506d811d61fSMark Cave-Ayland 
507d811d61fSMark Cave-Ayland     trace_pmu_dispatch_unknown_cmd(s->cmd);
508d811d61fSMark Cave-Ayland 
509d811d61fSMark Cave-Ayland     /* Manufacture fake response with 0's */
510d811d61fSMark Cave-Ayland     if (s->rsplen == -1) {
511d811d61fSMark Cave-Ayland         s->cmd_rsp_sz = 0;
512d811d61fSMark Cave-Ayland     } else {
513d811d61fSMark Cave-Ayland         s->cmd_rsp_sz = s->rsplen;
514d811d61fSMark Cave-Ayland         memset(s->cmd_rsp, 0, s->rsplen);
515d811d61fSMark Cave-Ayland     }
516d811d61fSMark Cave-Ayland }
517d811d61fSMark Cave-Ayland 
518d811d61fSMark Cave-Ayland static void pmu_update(PMUState *s)
519d811d61fSMark Cave-Ayland {
520d811d61fSMark Cave-Ayland     MOS6522PMUState *mps = &s->mos6522_pmu;
521d811d61fSMark Cave-Ayland     MOS6522State *ms = MOS6522(mps);
522d811d61fSMark Cave-Ayland 
523d811d61fSMark Cave-Ayland     /* Only react to changes in reg B */
524d811d61fSMark Cave-Ayland     if (ms->b == s->last_b) {
525d811d61fSMark Cave-Ayland         return;
526d811d61fSMark Cave-Ayland     }
527d811d61fSMark Cave-Ayland     s->last_b = ms->b;
528d811d61fSMark Cave-Ayland 
529d811d61fSMark Cave-Ayland     /* Check the TREQ / TACK state */
530d811d61fSMark Cave-Ayland     switch (ms->b & (TREQ | TACK)) {
531d811d61fSMark Cave-Ayland     case TREQ:
532d811d61fSMark Cave-Ayland         /* This is an ack release, handle it and bail out */
533d811d61fSMark Cave-Ayland         ms->b |= TACK;
534d811d61fSMark Cave-Ayland         s->last_b = ms->b;
535d811d61fSMark Cave-Ayland 
536d811d61fSMark Cave-Ayland         trace_pmu_debug_protocol_string("handshake: TREQ high, setting TACK");
537d811d61fSMark Cave-Ayland         return;
538d811d61fSMark Cave-Ayland     case TACK:
539d811d61fSMark Cave-Ayland         /* This is a valid request, handle below */
540d811d61fSMark Cave-Ayland         break;
541d811d61fSMark Cave-Ayland     case TREQ | TACK:
542d811d61fSMark Cave-Ayland         /* This is an idle state */
543d811d61fSMark Cave-Ayland         return;
544d811d61fSMark Cave-Ayland     default:
545d811d61fSMark Cave-Ayland         /* Invalid state, log and ignore */
546d811d61fSMark Cave-Ayland         trace_pmu_debug_protocol_error(ms->b);
547d811d61fSMark Cave-Ayland         return;
548d811d61fSMark Cave-Ayland     }
549d811d61fSMark Cave-Ayland 
550d811d61fSMark Cave-Ayland     /* If we wanted to handle commands asynchronously, this is where
551d811d61fSMark Cave-Ayland      * we would delay the clearing of TACK until we are ready to send
552d811d61fSMark Cave-Ayland      * the response
553d811d61fSMark Cave-Ayland      */
554d811d61fSMark Cave-Ayland 
555d811d61fSMark Cave-Ayland     /* We have a request, handshake TACK so we don't stay in
556d811d61fSMark Cave-Ayland      * an invalid state. If we were concurrent with the OS we
557d811d61fSMark Cave-Ayland      * should only do this after we grabbed the SR but that isn't
558d811d61fSMark Cave-Ayland      * a problem here.
559d811d61fSMark Cave-Ayland      */
560d811d61fSMark Cave-Ayland 
561d811d61fSMark Cave-Ayland     trace_pmu_debug_protocol_clear_treq(s->cmd_state);
562d811d61fSMark Cave-Ayland 
563d811d61fSMark Cave-Ayland     ms->b &= ~TACK;
564d811d61fSMark Cave-Ayland     s->last_b = ms->b;
565d811d61fSMark Cave-Ayland 
566d811d61fSMark Cave-Ayland     /* Act according to state */
567d811d61fSMark Cave-Ayland     switch (s->cmd_state) {
568d811d61fSMark Cave-Ayland     case pmu_state_idle:
569d811d61fSMark Cave-Ayland         if (!(ms->acr & SR_OUT)) {
570d811d61fSMark Cave-Ayland             trace_pmu_debug_protocol_string("protocol error! "
571d811d61fSMark Cave-Ayland                                             "state idle, ACR reading");
572d811d61fSMark Cave-Ayland             break;
573d811d61fSMark Cave-Ayland         }
574d811d61fSMark Cave-Ayland 
575d811d61fSMark Cave-Ayland         s->cmd = ms->sr;
576d811d61fSMark Cave-Ayland         via_set_sr_int(s);
577d811d61fSMark Cave-Ayland         s->cmdlen = pmu_data_len[s->cmd][0];
578d811d61fSMark Cave-Ayland         s->rsplen = pmu_data_len[s->cmd][1];
579d811d61fSMark Cave-Ayland         s->cmd_buf_pos = 0;
580d811d61fSMark Cave-Ayland         s->cmd_rsp_pos = 0;
581d811d61fSMark Cave-Ayland         s->cmd_state = pmu_state_cmd;
582d811d61fSMark Cave-Ayland 
583d811d61fSMark Cave-Ayland         trace_pmu_debug_protocol_cmd(s->cmd, s->cmdlen, s->rsplen);
584d811d61fSMark Cave-Ayland         break;
585d811d61fSMark Cave-Ayland 
586d811d61fSMark Cave-Ayland     case pmu_state_cmd:
587d811d61fSMark Cave-Ayland         if (!(ms->acr & SR_OUT)) {
588d811d61fSMark Cave-Ayland             trace_pmu_debug_protocol_string("protocol error! "
589d811d61fSMark Cave-Ayland                                             "state cmd, ACR reading");
590d811d61fSMark Cave-Ayland             break;
591d811d61fSMark Cave-Ayland         }
592d811d61fSMark Cave-Ayland 
593d811d61fSMark Cave-Ayland         if (s->cmdlen == -1) {
594d811d61fSMark Cave-Ayland             trace_pmu_debug_protocol_cmdlen(ms->sr);
595d811d61fSMark Cave-Ayland 
596d811d61fSMark Cave-Ayland             s->cmdlen = ms->sr;
597d811d61fSMark Cave-Ayland             if (s->cmdlen > sizeof(s->cmd_buf)) {
598d811d61fSMark Cave-Ayland                 trace_pmu_debug_protocol_cmd_toobig(s->cmdlen);
599d811d61fSMark Cave-Ayland             }
600d811d61fSMark Cave-Ayland         } else if (s->cmd_buf_pos < sizeof(s->cmd_buf)) {
601d811d61fSMark Cave-Ayland             s->cmd_buf[s->cmd_buf_pos++] = ms->sr;
602d811d61fSMark Cave-Ayland         }
603d811d61fSMark Cave-Ayland 
604d811d61fSMark Cave-Ayland         via_set_sr_int(s);
605d811d61fSMark Cave-Ayland         break;
606d811d61fSMark Cave-Ayland 
607d811d61fSMark Cave-Ayland     case pmu_state_rsp:
608d811d61fSMark Cave-Ayland         if (ms->acr & SR_OUT) {
609d811d61fSMark Cave-Ayland             trace_pmu_debug_protocol_string("protocol error! "
610d811d61fSMark Cave-Ayland                                             "state resp, ACR writing");
611d811d61fSMark Cave-Ayland             break;
612d811d61fSMark Cave-Ayland         }
613d811d61fSMark Cave-Ayland 
614d811d61fSMark Cave-Ayland         if (s->rsplen == -1) {
615d811d61fSMark Cave-Ayland             trace_pmu_debug_protocol_cmd_send_resp_size(s->cmd_rsp_sz);
616d811d61fSMark Cave-Ayland 
617d811d61fSMark Cave-Ayland             ms->sr = s->cmd_rsp_sz;
618d811d61fSMark Cave-Ayland             s->rsplen = s->cmd_rsp_sz;
619d811d61fSMark Cave-Ayland         } else if (s->cmd_rsp_pos < s->cmd_rsp_sz) {
620d811d61fSMark Cave-Ayland             trace_pmu_debug_protocol_cmd_send_resp(s->cmd_rsp_pos, s->rsplen);
621d811d61fSMark Cave-Ayland 
622d811d61fSMark Cave-Ayland             ms->sr = s->cmd_rsp[s->cmd_rsp_pos++];
623d811d61fSMark Cave-Ayland         }
624d811d61fSMark Cave-Ayland 
625d811d61fSMark Cave-Ayland         via_set_sr_int(s);
626d811d61fSMark Cave-Ayland         break;
627d811d61fSMark Cave-Ayland     }
628d811d61fSMark Cave-Ayland 
629d811d61fSMark Cave-Ayland     /* Check for state completion */
630d811d61fSMark Cave-Ayland     if (s->cmd_state == pmu_state_cmd && s->cmdlen == s->cmd_buf_pos) {
631d811d61fSMark Cave-Ayland         trace_pmu_debug_protocol_string("Command reception complete, "
632d811d61fSMark Cave-Ayland                                         "dispatching...");
633d811d61fSMark Cave-Ayland 
634d811d61fSMark Cave-Ayland         pmu_dispatch_cmd(s);
635d811d61fSMark Cave-Ayland         s->cmd_state = pmu_state_rsp;
636d811d61fSMark Cave-Ayland     }
637d811d61fSMark Cave-Ayland 
638d811d61fSMark Cave-Ayland     if (s->cmd_state == pmu_state_rsp && s->rsplen == s->cmd_rsp_pos) {
639d811d61fSMark Cave-Ayland         trace_pmu_debug_protocol_cmd_resp_complete(ms->ier);
640d811d61fSMark Cave-Ayland 
641d811d61fSMark Cave-Ayland         s->cmd_state = pmu_state_idle;
642d811d61fSMark Cave-Ayland     }
643d811d61fSMark Cave-Ayland }
644d811d61fSMark Cave-Ayland 
645d811d61fSMark Cave-Ayland static uint64_t mos6522_pmu_read(void *opaque, hwaddr addr, unsigned size)
646d811d61fSMark Cave-Ayland {
647d811d61fSMark Cave-Ayland     PMUState *s = opaque;
648d811d61fSMark Cave-Ayland     MOS6522PMUState *mps = &s->mos6522_pmu;
649d811d61fSMark Cave-Ayland     MOS6522State *ms = MOS6522(mps);
650d811d61fSMark Cave-Ayland 
651d811d61fSMark Cave-Ayland     addr = (addr >> 9) & 0xf;
652d811d61fSMark Cave-Ayland     return mos6522_read(ms, addr, size);
653d811d61fSMark Cave-Ayland }
654d811d61fSMark Cave-Ayland 
655d811d61fSMark Cave-Ayland static void mos6522_pmu_write(void *opaque, hwaddr addr, uint64_t val,
656d811d61fSMark Cave-Ayland                               unsigned size)
657d811d61fSMark Cave-Ayland {
658d811d61fSMark Cave-Ayland     PMUState *s = opaque;
659d811d61fSMark Cave-Ayland     MOS6522PMUState *mps = &s->mos6522_pmu;
660d811d61fSMark Cave-Ayland     MOS6522State *ms = MOS6522(mps);
661d811d61fSMark Cave-Ayland 
662d811d61fSMark Cave-Ayland     addr = (addr >> 9) & 0xf;
663d811d61fSMark Cave-Ayland     mos6522_write(ms, addr, val, size);
664d811d61fSMark Cave-Ayland }
665d811d61fSMark Cave-Ayland 
666d811d61fSMark Cave-Ayland static const MemoryRegionOps mos6522_pmu_ops = {
667d811d61fSMark Cave-Ayland     .read = mos6522_pmu_read,
668d811d61fSMark Cave-Ayland     .write = mos6522_pmu_write,
669d811d61fSMark Cave-Ayland     .endianness = DEVICE_BIG_ENDIAN,
670d811d61fSMark Cave-Ayland     .impl = {
671d811d61fSMark Cave-Ayland         .min_access_size = 1,
672d811d61fSMark Cave-Ayland         .max_access_size = 1,
673d811d61fSMark Cave-Ayland     },
674d811d61fSMark Cave-Ayland };
675d811d61fSMark Cave-Ayland 
676d811d61fSMark Cave-Ayland static bool pmu_adb_state_needed(void *opaque)
677d811d61fSMark Cave-Ayland {
678d811d61fSMark Cave-Ayland     PMUState *s = opaque;
679d811d61fSMark Cave-Ayland 
680d811d61fSMark Cave-Ayland     return s->has_adb;
681d811d61fSMark Cave-Ayland }
682d811d61fSMark Cave-Ayland 
683d811d61fSMark Cave-Ayland static const VMStateDescription vmstate_pmu_adb = {
684d811d61fSMark Cave-Ayland     .name = "pmu/adb",
685d811d61fSMark Cave-Ayland     .version_id = 0,
686d811d61fSMark Cave-Ayland     .minimum_version_id = 0,
687d811d61fSMark Cave-Ayland     .needed = pmu_adb_state_needed,
688d811d61fSMark Cave-Ayland     .fields = (VMStateField[]) {
689d811d61fSMark Cave-Ayland         VMSTATE_UINT16(adb_poll_mask, PMUState),
690d811d61fSMark Cave-Ayland         VMSTATE_TIMER_PTR(adb_poll_timer, PMUState),
691d811d61fSMark Cave-Ayland         VMSTATE_UINT8(adb_reply_size, PMUState),
692d811d61fSMark Cave-Ayland         VMSTATE_BUFFER(adb_reply, PMUState),
6930c2adc17SDr. David Alan Gilbert         VMSTATE_END_OF_LIST()
694d811d61fSMark Cave-Ayland     }
695d811d61fSMark Cave-Ayland };
696d811d61fSMark Cave-Ayland 
697d811d61fSMark Cave-Ayland static const VMStateDescription vmstate_pmu = {
698d811d61fSMark Cave-Ayland     .name = "pmu",
699d811d61fSMark Cave-Ayland     .version_id = 0,
700d811d61fSMark Cave-Ayland     .minimum_version_id = 0,
701d811d61fSMark Cave-Ayland     .fields = (VMStateField[]) {
702d811d61fSMark Cave-Ayland         VMSTATE_STRUCT(mos6522_pmu.parent_obj, PMUState, 0, vmstate_mos6522,
703d811d61fSMark Cave-Ayland                        MOS6522State),
704d811d61fSMark Cave-Ayland         VMSTATE_UINT8(last_b, PMUState),
705d811d61fSMark Cave-Ayland         VMSTATE_UINT8(cmd, PMUState),
706d811d61fSMark Cave-Ayland         VMSTATE_UINT32(cmdlen, PMUState),
707d811d61fSMark Cave-Ayland         VMSTATE_UINT32(rsplen, PMUState),
708d811d61fSMark Cave-Ayland         VMSTATE_UINT8(cmd_buf_pos, PMUState),
709d811d61fSMark Cave-Ayland         VMSTATE_BUFFER(cmd_buf, PMUState),
710d811d61fSMark Cave-Ayland         VMSTATE_UINT8(cmd_rsp_pos, PMUState),
711d811d61fSMark Cave-Ayland         VMSTATE_UINT8(cmd_rsp_sz, PMUState),
712d811d61fSMark Cave-Ayland         VMSTATE_BUFFER(cmd_rsp, PMUState),
713d811d61fSMark Cave-Ayland         VMSTATE_UINT8(intbits, PMUState),
714d811d61fSMark Cave-Ayland         VMSTATE_UINT8(intmask, PMUState),
715d811d61fSMark Cave-Ayland         VMSTATE_UINT8(autopoll_rate_ms, PMUState),
716d811d61fSMark Cave-Ayland         VMSTATE_UINT8(autopoll_mask, PMUState),
717d811d61fSMark Cave-Ayland         VMSTATE_UINT32(tick_offset, PMUState),
718d811d61fSMark Cave-Ayland         VMSTATE_TIMER_PTR(one_sec_timer, PMUState),
719d811d61fSMark Cave-Ayland         VMSTATE_INT64(one_sec_target, PMUState),
720d811d61fSMark Cave-Ayland         VMSTATE_END_OF_LIST()
721d811d61fSMark Cave-Ayland     },
722d811d61fSMark Cave-Ayland     .subsections = (const VMStateDescription * []) {
723d811d61fSMark Cave-Ayland         &vmstate_pmu_adb,
724d811d61fSMark Cave-Ayland     }
725d811d61fSMark Cave-Ayland };
726d811d61fSMark Cave-Ayland 
727d811d61fSMark Cave-Ayland static void pmu_reset(DeviceState *dev)
728d811d61fSMark Cave-Ayland {
729d811d61fSMark Cave-Ayland     PMUState *s = VIA_PMU(dev);
730d811d61fSMark Cave-Ayland 
731d811d61fSMark Cave-Ayland     /* OpenBIOS needs to do this? MacOS 9 needs it */
732d811d61fSMark Cave-Ayland     s->intmask = PMU_INT_ADB | PMU_INT_TICK;
733d811d61fSMark Cave-Ayland     s->intbits = 0;
734d811d61fSMark Cave-Ayland 
735d811d61fSMark Cave-Ayland     s->cmd_state = pmu_state_idle;
736d811d61fSMark Cave-Ayland     s->autopoll_mask = 0;
737d811d61fSMark Cave-Ayland }
738d811d61fSMark Cave-Ayland 
739d811d61fSMark Cave-Ayland static void pmu_realize(DeviceState *dev, Error **errp)
740d811d61fSMark Cave-Ayland {
741d811d61fSMark Cave-Ayland     PMUState *s = VIA_PMU(dev);
742d811d61fSMark Cave-Ayland     SysBusDevice *sbd;
743d811d61fSMark Cave-Ayland     MOS6522State *ms;
744d811d61fSMark Cave-Ayland     DeviceState *d;
745d811d61fSMark Cave-Ayland     struct tm tm;
746d811d61fSMark Cave-Ayland 
747d811d61fSMark Cave-Ayland     /* Pass IRQ from 6522 */
748d811d61fSMark Cave-Ayland     d = DEVICE(&s->mos6522_pmu);
749d811d61fSMark Cave-Ayland     ms = MOS6522(d);
750d811d61fSMark Cave-Ayland     sbd = SYS_BUS_DEVICE(s);
751d811d61fSMark Cave-Ayland     sysbus_pass_irq(sbd, SYS_BUS_DEVICE(ms));
752d811d61fSMark Cave-Ayland 
753d811d61fSMark Cave-Ayland     qemu_get_timedate(&tm, 0);
754d811d61fSMark Cave-Ayland     s->tick_offset = (uint32_t)mktimegm(&tm) + RTC_OFFSET;
755d811d61fSMark Cave-Ayland     s->one_sec_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL, pmu_one_sec_timer, s);
756d811d61fSMark Cave-Ayland     s->one_sec_target = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + 1000;
757d811d61fSMark Cave-Ayland     timer_mod(s->one_sec_timer, s->one_sec_target);
758d811d61fSMark Cave-Ayland 
759d811d61fSMark Cave-Ayland     if (s->has_adb) {
760d811d61fSMark Cave-Ayland         qbus_create_inplace(&s->adb_bus, sizeof(s->adb_bus), TYPE_ADB_BUS,
761d811d61fSMark Cave-Ayland                             DEVICE(dev), "adb.0");
762d811d61fSMark Cave-Ayland         s->adb_poll_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL, pmu_adb_poll, s);
763d811d61fSMark Cave-Ayland         s->adb_poll_mask = 0xffff;
764d811d61fSMark Cave-Ayland         s->autopoll_rate_ms = 20;
765d811d61fSMark Cave-Ayland     }
766d811d61fSMark Cave-Ayland }
767d811d61fSMark Cave-Ayland 
768d811d61fSMark Cave-Ayland static void pmu_init(Object *obj)
769d811d61fSMark Cave-Ayland {
770d811d61fSMark Cave-Ayland     SysBusDevice *d = SYS_BUS_DEVICE(obj);
771d811d61fSMark Cave-Ayland     PMUState *s = VIA_PMU(obj);
772d811d61fSMark Cave-Ayland 
773d811d61fSMark Cave-Ayland     object_property_add_link(obj, "gpio", TYPE_MACIO_GPIO,
774d811d61fSMark Cave-Ayland                              (Object **) &s->gpio,
775d811d61fSMark Cave-Ayland                              qdev_prop_allow_set_link_before_realize,
776d811d61fSMark Cave-Ayland                              0, NULL);
777d811d61fSMark Cave-Ayland 
7781069a3c6SThomas Huth     sysbus_init_child_obj(obj, "mos6522-pmu", &s->mos6522_pmu,
7791069a3c6SThomas Huth                           sizeof(s->mos6522_pmu), TYPE_MOS6522_PMU);
780d811d61fSMark Cave-Ayland 
781d811d61fSMark Cave-Ayland     memory_region_init_io(&s->mem, obj, &mos6522_pmu_ops, s, "via-pmu",
782d811d61fSMark Cave-Ayland                           0x2000);
783d811d61fSMark Cave-Ayland     sysbus_init_mmio(d, &s->mem);
784d811d61fSMark Cave-Ayland }
785d811d61fSMark Cave-Ayland 
786d811d61fSMark Cave-Ayland static Property pmu_properties[] = {
787d811d61fSMark Cave-Ayland     DEFINE_PROP_BOOL("has-adb", PMUState, has_adb, true),
788d811d61fSMark Cave-Ayland     DEFINE_PROP_END_OF_LIST()
789d811d61fSMark Cave-Ayland };
790d811d61fSMark Cave-Ayland 
791d811d61fSMark Cave-Ayland static void pmu_class_init(ObjectClass *oc, void *data)
792d811d61fSMark Cave-Ayland {
793d811d61fSMark Cave-Ayland     DeviceClass *dc = DEVICE_CLASS(oc);
794d811d61fSMark Cave-Ayland 
795d811d61fSMark Cave-Ayland     dc->realize = pmu_realize;
796d811d61fSMark Cave-Ayland     dc->reset = pmu_reset;
797d811d61fSMark Cave-Ayland     dc->vmsd = &vmstate_pmu;
798d811d61fSMark Cave-Ayland     dc->props = pmu_properties;
799d811d61fSMark Cave-Ayland     set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories);
800d811d61fSMark Cave-Ayland }
801d811d61fSMark Cave-Ayland 
802d811d61fSMark Cave-Ayland static const TypeInfo pmu_type_info = {
803d811d61fSMark Cave-Ayland     .name = TYPE_VIA_PMU,
804d811d61fSMark Cave-Ayland     .parent = TYPE_SYS_BUS_DEVICE,
805d811d61fSMark Cave-Ayland     .instance_size = sizeof(PMUState),
806d811d61fSMark Cave-Ayland     .instance_init = pmu_init,
807d811d61fSMark Cave-Ayland     .class_init = pmu_class_init,
808d811d61fSMark Cave-Ayland };
809d811d61fSMark Cave-Ayland 
810d811d61fSMark Cave-Ayland static void mos6522_pmu_portB_write(MOS6522State *s)
811d811d61fSMark Cave-Ayland {
812d811d61fSMark Cave-Ayland     MOS6522PMUState *mps = container_of(s, MOS6522PMUState, parent_obj);
813d811d61fSMark Cave-Ayland     PMUState *ps = container_of(mps, PMUState, mos6522_pmu);
814d811d61fSMark Cave-Ayland 
815d811d61fSMark Cave-Ayland     if ((s->pcr & 0xe0) == 0x20 || (s->pcr & 0xe0) == 0x60) {
816d811d61fSMark Cave-Ayland         s->ifr &= ~CB2_INT;
817d811d61fSMark Cave-Ayland     }
818d811d61fSMark Cave-Ayland     s->ifr &= ~CB1_INT;
819d811d61fSMark Cave-Ayland 
820d811d61fSMark Cave-Ayland     via_update_irq(ps);
821d811d61fSMark Cave-Ayland     pmu_update(ps);
822d811d61fSMark Cave-Ayland }
823d811d61fSMark Cave-Ayland 
824d811d61fSMark Cave-Ayland static void mos6522_pmu_portA_write(MOS6522State *s)
825d811d61fSMark Cave-Ayland {
826d811d61fSMark Cave-Ayland     MOS6522PMUState *mps = container_of(s, MOS6522PMUState, parent_obj);
827d811d61fSMark Cave-Ayland     PMUState *ps = container_of(mps, PMUState, mos6522_pmu);
828d811d61fSMark Cave-Ayland 
829d811d61fSMark Cave-Ayland     if ((s->pcr & 0x0e) == 0x02 || (s->pcr & 0x0e) == 0x06) {
830d811d61fSMark Cave-Ayland         s->ifr &= ~CA2_INT;
831d811d61fSMark Cave-Ayland     }
832d811d61fSMark Cave-Ayland     s->ifr &= ~CA1_INT;
833d811d61fSMark Cave-Ayland 
834d811d61fSMark Cave-Ayland     via_update_irq(ps);
835d811d61fSMark Cave-Ayland }
836d811d61fSMark Cave-Ayland 
837d811d61fSMark Cave-Ayland static void mos6522_pmu_reset(DeviceState *dev)
838d811d61fSMark Cave-Ayland {
839d811d61fSMark Cave-Ayland     MOS6522State *ms = MOS6522(dev);
840d811d61fSMark Cave-Ayland     MOS6522PMUState *mps = container_of(ms, MOS6522PMUState, parent_obj);
841d811d61fSMark Cave-Ayland     PMUState *s = container_of(mps, PMUState, mos6522_pmu);
842d811d61fSMark Cave-Ayland     MOS6522DeviceClass *mdc = MOS6522_DEVICE_GET_CLASS(ms);
843d811d61fSMark Cave-Ayland 
844d811d61fSMark Cave-Ayland     mdc->parent_reset(dev);
845d811d61fSMark Cave-Ayland 
846d811d61fSMark Cave-Ayland     ms->timers[0].frequency = VIA_TIMER_FREQ;
847d811d61fSMark Cave-Ayland     ms->timers[1].frequency = (SCALE_US * 6000) / 4700;
848d811d61fSMark Cave-Ayland 
849d811d61fSMark Cave-Ayland     s->last_b = ms->b = TACK | TREQ;
850d811d61fSMark Cave-Ayland }
851d811d61fSMark Cave-Ayland 
852d811d61fSMark Cave-Ayland static void mos6522_pmu_class_init(ObjectClass *oc, void *data)
853d811d61fSMark Cave-Ayland {
854d811d61fSMark Cave-Ayland     DeviceClass *dc = DEVICE_CLASS(oc);
855d811d61fSMark Cave-Ayland     MOS6522DeviceClass *mdc = MOS6522_DEVICE_CLASS(oc);
856d811d61fSMark Cave-Ayland 
857d811d61fSMark Cave-Ayland     dc->reset = mos6522_pmu_reset;
858d811d61fSMark Cave-Ayland     mdc->portB_write = mos6522_pmu_portB_write;
859d811d61fSMark Cave-Ayland     mdc->portA_write = mos6522_pmu_portA_write;
860d811d61fSMark Cave-Ayland }
861d811d61fSMark Cave-Ayland 
862d811d61fSMark Cave-Ayland static const TypeInfo mos6522_pmu_type_info = {
863d811d61fSMark Cave-Ayland     .name = TYPE_MOS6522_PMU,
864d811d61fSMark Cave-Ayland     .parent = TYPE_MOS6522,
865d811d61fSMark Cave-Ayland     .instance_size = sizeof(MOS6522PMUState),
866d811d61fSMark Cave-Ayland     .class_init = mos6522_pmu_class_init,
867d811d61fSMark Cave-Ayland };
868d811d61fSMark Cave-Ayland 
869d811d61fSMark Cave-Ayland static void pmu_register_types(void)
870d811d61fSMark Cave-Ayland {
871d811d61fSMark Cave-Ayland     type_register_static(&pmu_type_info);
872d811d61fSMark Cave-Ayland     type_register_static(&mos6522_pmu_type_info);
873d811d61fSMark Cave-Ayland }
874d811d61fSMark Cave-Ayland 
875d811d61fSMark Cave-Ayland type_init(pmu_register_types)
876