1 /*
2 * QEMU HP Lasi PS/2 interface emulation
3 *
4 * Copyright (c) 2019 Sven Schnelle
5 *
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
12 *
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
15 *
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22 * THE SOFTWARE.
23 */
24 #include "qemu/osdep.h"
25 #include "qemu/log.h"
26 #include "hw/qdev-properties.h"
27 #include "hw/sysbus.h"
28 #include "hw/input/ps2.h"
29 #include "hw/input/lasips2.h"
30 #include "exec/hwaddr.h"
31 #include "trace.h"
32 #include "exec/address-spaces.h"
33 #include "migration/vmstate.h"
34 #include "hw/irq.h"
35 #include "qapi/error.h"
36
37
38 static const VMStateDescription vmstate_lasips2_port = {
39 .name = "lasips2-port",
40 .version_id = 1,
41 .minimum_version_id = 1,
42 .fields = (const VMStateField[]) {
43 VMSTATE_UINT8(control, LASIPS2Port),
44 VMSTATE_UINT8(buf, LASIPS2Port),
45 VMSTATE_BOOL(loopback_rbne, LASIPS2Port),
46 VMSTATE_END_OF_LIST()
47 }
48 };
49
50 static const VMStateDescription vmstate_lasips2 = {
51 .name = "lasips2",
52 .version_id = 1,
53 .minimum_version_id = 1,
54 .fields = (const VMStateField[]) {
55 VMSTATE_UINT8(int_status, LASIPS2State),
56 VMSTATE_STRUCT(kbd_port.parent_obj, LASIPS2State, 1,
57 vmstate_lasips2_port, LASIPS2Port),
58 VMSTATE_STRUCT(mouse_port.parent_obj, LASIPS2State, 1,
59 vmstate_lasips2_port, LASIPS2Port),
60 VMSTATE_END_OF_LIST()
61 }
62 };
63
64 typedef enum {
65 REG_PS2_ID = 0,
66 REG_PS2_RCVDATA = 4,
67 REG_PS2_CONTROL = 8,
68 REG_PS2_STATUS = 12,
69 } lasips2_read_reg_t;
70
71 typedef enum {
72 REG_PS2_RESET = 0,
73 REG_PS2_XMTDATA = 4,
74 } lasips2_write_reg_t;
75
76 typedef enum {
77 LASIPS2_CONTROL_ENABLE = 0x01,
78 LASIPS2_CONTROL_LOOPBACK = 0x02,
79 LASIPS2_CONTROL_DIAG = 0x20,
80 LASIPS2_CONTROL_DATDIR = 0x40,
81 LASIPS2_CONTROL_CLKDIR = 0x80,
82 } lasips2_control_reg_t;
83
84 typedef enum {
85 LASIPS2_STATUS_RBNE = 0x01,
86 LASIPS2_STATUS_TBNE = 0x02,
87 LASIPS2_STATUS_TERR = 0x04,
88 LASIPS2_STATUS_PERR = 0x08,
89 LASIPS2_STATUS_CMPINTR = 0x10,
90 LASIPS2_STATUS_DATSHD = 0x40,
91 LASIPS2_STATUS_CLKSHD = 0x80,
92 } lasips2_status_reg_t;
93
lasips2_read_reg_name(uint64_t addr)94 static const char *lasips2_read_reg_name(uint64_t addr)
95 {
96 switch (addr & 0xc) {
97 case REG_PS2_ID:
98 return " PS2_ID";
99
100 case REG_PS2_RCVDATA:
101 return " PS2_RCVDATA";
102
103 case REG_PS2_CONTROL:
104 return " PS2_CONTROL";
105
106 case REG_PS2_STATUS:
107 return " PS2_STATUS";
108
109 default:
110 return "";
111 }
112 }
113
lasips2_write_reg_name(uint64_t addr)114 static const char *lasips2_write_reg_name(uint64_t addr)
115 {
116 switch (addr & 0x0c) {
117 case REG_PS2_RESET:
118 return " PS2_RESET";
119
120 case REG_PS2_XMTDATA:
121 return " PS2_XMTDATA";
122
123 case REG_PS2_CONTROL:
124 return " PS2_CONTROL";
125
126 default:
127 return "";
128 }
129 }
130
lasips2_update_irq(LASIPS2State * s)131 static void lasips2_update_irq(LASIPS2State *s)
132 {
133 int level = s->int_status ? 1 : 0;
134
135 trace_lasips2_intr(level);
136 qemu_set_irq(s->irq, level);
137 }
138
lasips2_set_irq(void * opaque,int n,int level)139 static void lasips2_set_irq(void *opaque, int n, int level)
140 {
141 LASIPS2State *s = LASIPS2(opaque);
142
143 if (level) {
144 s->int_status |= BIT(n);
145 } else {
146 s->int_status &= ~BIT(n);
147 }
148
149 lasips2_update_irq(s);
150 }
151
lasips2_reg_write(void * opaque,hwaddr addr,uint64_t val,unsigned size)152 static void lasips2_reg_write(void *opaque, hwaddr addr, uint64_t val,
153 unsigned size)
154 {
155 LASIPS2Port *lp = LASIPS2_PORT(opaque);
156
157 trace_lasips2_reg_write(size, lp->id, addr,
158 lasips2_write_reg_name(addr), val);
159
160 switch (addr & 0xc) {
161 case REG_PS2_CONTROL:
162 lp->control = val;
163 break;
164
165 case REG_PS2_XMTDATA:
166 if (lp->control & LASIPS2_CONTROL_LOOPBACK) {
167 lp->buf = val;
168 lp->loopback_rbne = true;
169 qemu_set_irq(lp->irq, 1);
170 break;
171 }
172
173 if (lp->id) {
174 ps2_write_mouse(PS2_MOUSE_DEVICE(lp->ps2dev), val);
175 } else {
176 ps2_write_keyboard(PS2_KBD_DEVICE(lp->ps2dev), val);
177 }
178 break;
179
180 case REG_PS2_RESET:
181 break;
182
183 default:
184 qemu_log_mask(LOG_UNIMP, "%s: unknown register 0x%02" HWADDR_PRIx "\n",
185 __func__, addr);
186 break;
187 }
188 }
189
lasips2_reg_read(void * opaque,hwaddr addr,unsigned size)190 static uint64_t lasips2_reg_read(void *opaque, hwaddr addr, unsigned size)
191 {
192 LASIPS2Port *lp = LASIPS2_PORT(opaque);
193 uint64_t ret = 0;
194
195 switch (addr & 0xc) {
196 case REG_PS2_ID:
197 ret = lp->id;
198 break;
199
200 case REG_PS2_RCVDATA:
201 if (lp->control & LASIPS2_CONTROL_LOOPBACK) {
202 lp->loopback_rbne = false;
203 qemu_set_irq(lp->irq, 0);
204 ret = lp->buf;
205 break;
206 }
207
208 ret = ps2_read_data(lp->ps2dev);
209 break;
210
211 case REG_PS2_CONTROL:
212 ret = lp->control;
213 break;
214
215 case REG_PS2_STATUS:
216 ret = LASIPS2_STATUS_DATSHD | LASIPS2_STATUS_CLKSHD;
217
218 if (lp->control & LASIPS2_CONTROL_DIAG) {
219 if (!(lp->control & LASIPS2_CONTROL_DATDIR)) {
220 ret &= ~LASIPS2_STATUS_DATSHD;
221 }
222
223 if (!(lp->control & LASIPS2_CONTROL_CLKDIR)) {
224 ret &= ~LASIPS2_STATUS_CLKSHD;
225 }
226 }
227
228 if (lp->control & LASIPS2_CONTROL_LOOPBACK) {
229 if (lp->loopback_rbne) {
230 ret |= LASIPS2_STATUS_RBNE;
231 }
232 } else {
233 if (!ps2_queue_empty(lp->ps2dev)) {
234 ret |= LASIPS2_STATUS_RBNE;
235 }
236 }
237
238 if (lp->lasips2->int_status) {
239 ret |= LASIPS2_STATUS_CMPINTR;
240 }
241 break;
242
243 default:
244 qemu_log_mask(LOG_UNIMP, "%s: unknown register 0x%02" HWADDR_PRIx "\n",
245 __func__, addr);
246 break;
247 }
248
249 trace_lasips2_reg_read(size, lp->id, addr,
250 lasips2_read_reg_name(addr), ret);
251 return ret;
252 }
253
254 static const MemoryRegionOps lasips2_reg_ops = {
255 .read = lasips2_reg_read,
256 .write = lasips2_reg_write,
257 .impl = {
258 .min_access_size = 1,
259 .max_access_size = 4,
260 },
261 .endianness = DEVICE_BIG_ENDIAN,
262 };
263
lasips2_realize(DeviceState * dev,Error ** errp)264 static void lasips2_realize(DeviceState *dev, Error **errp)
265 {
266 LASIPS2State *s = LASIPS2(dev);
267 LASIPS2Port *lp;
268
269 lp = LASIPS2_PORT(&s->kbd_port);
270 if (!(qdev_realize(DEVICE(lp), NULL, errp))) {
271 return;
272 }
273
274 qdev_connect_gpio_out(DEVICE(lp), 0,
275 qdev_get_gpio_in_named(dev, "lasips2-port-input-irq",
276 lp->id));
277
278 lp = LASIPS2_PORT(&s->mouse_port);
279 if (!(qdev_realize(DEVICE(lp), NULL, errp))) {
280 return;
281 }
282
283 qdev_connect_gpio_out(DEVICE(lp), 0,
284 qdev_get_gpio_in_named(dev, "lasips2-port-input-irq",
285 lp->id));
286 }
287
lasips2_init(Object * obj)288 static void lasips2_init(Object *obj)
289 {
290 LASIPS2State *s = LASIPS2(obj);
291 LASIPS2Port *lp;
292
293 object_initialize_child(obj, "lasips2-kbd-port", &s->kbd_port,
294 TYPE_LASIPS2_KBD_PORT);
295 object_initialize_child(obj, "lasips2-mouse-port", &s->mouse_port,
296 TYPE_LASIPS2_MOUSE_PORT);
297
298 lp = LASIPS2_PORT(&s->kbd_port);
299 sysbus_init_mmio(SYS_BUS_DEVICE(obj), &lp->reg);
300 lp = LASIPS2_PORT(&s->mouse_port);
301 sysbus_init_mmio(SYS_BUS_DEVICE(obj), &lp->reg);
302
303 sysbus_init_irq(SYS_BUS_DEVICE(obj), &s->irq);
304
305 qdev_init_gpio_in_named(DEVICE(obj), lasips2_set_irq,
306 "lasips2-port-input-irq", 2);
307 }
308
lasips2_class_init(ObjectClass * klass,void * data)309 static void lasips2_class_init(ObjectClass *klass, void *data)
310 {
311 DeviceClass *dc = DEVICE_CLASS(klass);
312
313 dc->realize = lasips2_realize;
314 dc->vmsd = &vmstate_lasips2;
315 set_bit(DEVICE_CATEGORY_INPUT, dc->categories);
316 }
317
318 static const TypeInfo lasips2_info = {
319 .name = TYPE_LASIPS2,
320 .parent = TYPE_SYS_BUS_DEVICE,
321 .instance_init = lasips2_init,
322 .instance_size = sizeof(LASIPS2State),
323 .class_init = lasips2_class_init,
324 };
325
lasips2_port_set_irq(void * opaque,int n,int level)326 static void lasips2_port_set_irq(void *opaque, int n, int level)
327 {
328 LASIPS2Port *s = LASIPS2_PORT(opaque);
329
330 qemu_set_irq(s->irq, level);
331 }
332
lasips2_port_realize(DeviceState * dev,Error ** errp)333 static void lasips2_port_realize(DeviceState *dev, Error **errp)
334 {
335 LASIPS2Port *s = LASIPS2_PORT(dev);
336
337 qdev_connect_gpio_out(DEVICE(s->ps2dev), PS2_DEVICE_IRQ,
338 qdev_get_gpio_in_named(dev, "ps2-input-irq", 0));
339 }
340
lasips2_port_init(Object * obj)341 static void lasips2_port_init(Object *obj)
342 {
343 LASIPS2Port *s = LASIPS2_PORT(obj);
344
345 qdev_init_gpio_out(DEVICE(obj), &s->irq, 1);
346 qdev_init_gpio_in_named(DEVICE(obj), lasips2_port_set_irq,
347 "ps2-input-irq", 1);
348 }
349
lasips2_port_class_init(ObjectClass * klass,void * data)350 static void lasips2_port_class_init(ObjectClass *klass, void *data)
351 {
352 DeviceClass *dc = DEVICE_CLASS(klass);
353
354 /*
355 * The PS/2 mouse port is integreal part of LASI and can not be
356 * created by users without LASI.
357 */
358 dc->user_creatable = false;
359 dc->realize = lasips2_port_realize;
360 }
361
362 static const TypeInfo lasips2_port_info = {
363 .name = TYPE_LASIPS2_PORT,
364 .parent = TYPE_DEVICE,
365 .instance_init = lasips2_port_init,
366 .instance_size = sizeof(LASIPS2Port),
367 .class_init = lasips2_port_class_init,
368 .class_size = sizeof(LASIPS2PortDeviceClass),
369 .abstract = true,
370 };
371
lasips2_kbd_port_realize(DeviceState * dev,Error ** errp)372 static void lasips2_kbd_port_realize(DeviceState *dev, Error **errp)
373 {
374 LASIPS2KbdPort *s = LASIPS2_KBD_PORT(dev);
375 LASIPS2Port *lp = LASIPS2_PORT(dev);
376 LASIPS2PortDeviceClass *lpdc = LASIPS2_PORT_GET_CLASS(lp);
377
378 if (!sysbus_realize(SYS_BUS_DEVICE(&s->kbd), errp)) {
379 return;
380 }
381
382 lp->ps2dev = PS2_DEVICE(&s->kbd);
383 lpdc->parent_realize(dev, errp);
384 }
385
lasips2_kbd_port_init(Object * obj)386 static void lasips2_kbd_port_init(Object *obj)
387 {
388 LASIPS2KbdPort *s = LASIPS2_KBD_PORT(obj);
389 LASIPS2Port *lp = LASIPS2_PORT(obj);
390
391 memory_region_init_io(&lp->reg, obj, &lasips2_reg_ops, lp, "lasips2-kbd",
392 0x100);
393
394 object_initialize_child(obj, "kbd", &s->kbd, TYPE_PS2_KBD_DEVICE);
395
396 lp->id = 0;
397 lp->lasips2 = container_of(s, LASIPS2State, kbd_port);
398 }
399
lasips2_kbd_port_class_init(ObjectClass * klass,void * data)400 static void lasips2_kbd_port_class_init(ObjectClass *klass, void *data)
401 {
402 DeviceClass *dc = DEVICE_CLASS(klass);
403 LASIPS2PortDeviceClass *lpdc = LASIPS2_PORT_CLASS(klass);
404
405 /*
406 * The PS/2 keyboard port is integreal part of LASI and can not be
407 * created by users without LASI.
408 */
409 dc->user_creatable = false;
410 device_class_set_parent_realize(dc, lasips2_kbd_port_realize,
411 &lpdc->parent_realize);
412 }
413
414 static const TypeInfo lasips2_kbd_port_info = {
415 .name = TYPE_LASIPS2_KBD_PORT,
416 .parent = TYPE_LASIPS2_PORT,
417 .instance_size = sizeof(LASIPS2KbdPort),
418 .instance_init = lasips2_kbd_port_init,
419 .class_init = lasips2_kbd_port_class_init,
420 };
421
lasips2_mouse_port_realize(DeviceState * dev,Error ** errp)422 static void lasips2_mouse_port_realize(DeviceState *dev, Error **errp)
423 {
424 LASIPS2MousePort *s = LASIPS2_MOUSE_PORT(dev);
425 LASIPS2Port *lp = LASIPS2_PORT(dev);
426 LASIPS2PortDeviceClass *lpdc = LASIPS2_PORT_GET_CLASS(lp);
427
428 if (!sysbus_realize(SYS_BUS_DEVICE(&s->mouse), errp)) {
429 return;
430 }
431
432 lp->ps2dev = PS2_DEVICE(&s->mouse);
433 lpdc->parent_realize(dev, errp);
434 }
435
lasips2_mouse_port_init(Object * obj)436 static void lasips2_mouse_port_init(Object *obj)
437 {
438 LASIPS2MousePort *s = LASIPS2_MOUSE_PORT(obj);
439 LASIPS2Port *lp = LASIPS2_PORT(obj);
440
441 memory_region_init_io(&lp->reg, obj, &lasips2_reg_ops, lp, "lasips2-mouse",
442 0x100);
443
444 object_initialize_child(obj, "mouse", &s->mouse, TYPE_PS2_MOUSE_DEVICE);
445
446 lp->id = 1;
447 lp->lasips2 = container_of(s, LASIPS2State, mouse_port);
448 }
449
lasips2_mouse_port_class_init(ObjectClass * klass,void * data)450 static void lasips2_mouse_port_class_init(ObjectClass *klass, void *data)
451 {
452 DeviceClass *dc = DEVICE_CLASS(klass);
453 LASIPS2PortDeviceClass *lpdc = LASIPS2_PORT_CLASS(klass);
454
455 device_class_set_parent_realize(dc, lasips2_mouse_port_realize,
456 &lpdc->parent_realize);
457 }
458
459 static const TypeInfo lasips2_mouse_port_info = {
460 .name = TYPE_LASIPS2_MOUSE_PORT,
461 .parent = TYPE_LASIPS2_PORT,
462 .instance_size = sizeof(LASIPS2MousePort),
463 .instance_init = lasips2_mouse_port_init,
464 .class_init = lasips2_mouse_port_class_init,
465 };
466
lasips2_register_types(void)467 static void lasips2_register_types(void)
468 {
469 type_register_static(&lasips2_info);
470 type_register_static(&lasips2_port_info);
471 type_register_static(&lasips2_kbd_port_info);
472 type_register_static(&lasips2_mouse_port_info);
473 }
474
475 type_init(lasips2_register_types)
476