mirror of
				https://github.com/qemu/qemu.git
				synced 2025-10-27 13:30:41 +00:00 
			
		
		
		
	 1b7bd0abe9
			
		
	
	
		1b7bd0abe9
		
	
	
	
	
		
			
			Since this series has already introduced a migration break for the HPPA B160L machine, we can use this opportunity to improve the VMStateDescription for the LASIPS2 device. Add the new int_status field to the VMStateDescription and remodel the ports as separate VMSTATE_STRUCT instances representing each LASIPS2Port. Once this is done, the migration stream can be updated to include buf and loopback_rbne for each port (which is necessary since the values are accessed across separate IO accesses), and drop the port id as this is hardcoded for each port type. Signed-off-by: Mark Cave-Ayland <mark.cave-ayland@ilande.co.uk> Tested-by: Helge Deller <deller@gmx.de> Acked-by: Helge Deller <deller@gmx.de> Message-Id: <20220712215251.7944-35-mark.cave-ayland@ilande.co.uk> Reviewed-by: Philippe Mathieu-Daudé <f4bug@amsat.org>
		
			
				
	
	
		
			466 lines
		
	
	
		
			13 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			466 lines
		
	
	
		
			13 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * QEMU HP Lasi PS/2 interface emulation
 | |
|  *
 | |
|  * Copyright (c) 2019 Sven Schnelle
 | |
|  *
 | |
|  * Permission is hereby granted, free of charge, to any person obtaining a copy
 | |
|  * of this software and associated documentation files (the "Software"), to deal
 | |
|  * in the Software without restriction, including without limitation the rights
 | |
|  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 | |
|  * copies of the Software, and to permit persons to whom the Software is
 | |
|  * furnished to do so, subject to the following conditions:
 | |
|  *
 | |
|  * The above copyright notice and this permission notice shall be included in
 | |
|  * all copies or substantial portions of the Software.
 | |
|  *
 | |
|  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 | |
|  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 | |
|  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 | |
|  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 | |
|  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 | |
|  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 | |
|  * THE SOFTWARE.
 | |
|  */
 | |
| #include "qemu/osdep.h"
 | |
| #include "qemu/log.h"
 | |
| #include "hw/qdev-properties.h"
 | |
| #include "hw/sysbus.h"
 | |
| #include "hw/input/ps2.h"
 | |
| #include "hw/input/lasips2.h"
 | |
| #include "exec/hwaddr.h"
 | |
| #include "trace.h"
 | |
| #include "exec/address-spaces.h"
 | |
| #include "migration/vmstate.h"
 | |
| #include "hw/irq.h"
 | |
| #include "qapi/error.h"
 | |
| 
 | |
| 
 | |
| static const VMStateDescription vmstate_lasips2_port = {
 | |
|     .name = "lasips2-port",
 | |
|     .version_id = 1,
 | |
|     .minimum_version_id = 1,
 | |
|     .fields = (VMStateField[]) {
 | |
|         VMSTATE_UINT8(control, LASIPS2Port),
 | |
|         VMSTATE_UINT8(buf, LASIPS2Port),
 | |
|         VMSTATE_BOOL(loopback_rbne, LASIPS2Port),
 | |
|         VMSTATE_END_OF_LIST()
 | |
|     }
 | |
| };
 | |
| 
 | |
| static const VMStateDescription vmstate_lasips2 = {
 | |
|     .name = "lasips2",
 | |
|     .version_id = 1,
 | |
|     .minimum_version_id = 1,
 | |
|     .fields = (VMStateField[]) {
 | |
|         VMSTATE_UINT8(int_status, LASIPS2State),
 | |
|         VMSTATE_STRUCT(kbd_port.parent_obj, LASIPS2State, 1,
 | |
|                        vmstate_lasips2_port, LASIPS2Port),
 | |
|         VMSTATE_STRUCT(mouse_port.parent_obj, LASIPS2State, 1,
 | |
|                        vmstate_lasips2_port, LASIPS2Port),
 | |
|         VMSTATE_END_OF_LIST()
 | |
|     }
 | |
| };
 | |
| 
 | |
| typedef enum {
 | |
|     REG_PS2_ID = 0,
 | |
|     REG_PS2_RCVDATA = 4,
 | |
|     REG_PS2_CONTROL = 8,
 | |
|     REG_PS2_STATUS = 12,
 | |
| } lasips2_read_reg_t;
 | |
| 
 | |
| typedef enum {
 | |
|     REG_PS2_RESET = 0,
 | |
|     REG_PS2_XMTDATA = 4,
 | |
| } lasips2_write_reg_t;
 | |
| 
 | |
| typedef enum {
 | |
|     LASIPS2_CONTROL_ENABLE = 0x01,
 | |
|     LASIPS2_CONTROL_LOOPBACK = 0x02,
 | |
|     LASIPS2_CONTROL_DIAG = 0x20,
 | |
|     LASIPS2_CONTROL_DATDIR = 0x40,
 | |
|     LASIPS2_CONTROL_CLKDIR = 0x80,
 | |
| } lasips2_control_reg_t;
 | |
| 
 | |
| typedef enum {
 | |
|     LASIPS2_STATUS_RBNE = 0x01,
 | |
|     LASIPS2_STATUS_TBNE = 0x02,
 | |
|     LASIPS2_STATUS_TERR = 0x04,
 | |
|     LASIPS2_STATUS_PERR = 0x08,
 | |
|     LASIPS2_STATUS_CMPINTR = 0x10,
 | |
|     LASIPS2_STATUS_DATSHD = 0x40,
 | |
|     LASIPS2_STATUS_CLKSHD = 0x80,
 | |
| } lasips2_status_reg_t;
 | |
| 
 | |
| static const char *lasips2_read_reg_name(uint64_t addr)
 | |
| {
 | |
|     switch (addr & 0xc) {
 | |
|     case REG_PS2_ID:
 | |
|         return " PS2_ID";
 | |
| 
 | |
|     case REG_PS2_RCVDATA:
 | |
|         return " PS2_RCVDATA";
 | |
| 
 | |
|     case REG_PS2_CONTROL:
 | |
|         return " PS2_CONTROL";
 | |
| 
 | |
|     case REG_PS2_STATUS:
 | |
|         return " PS2_STATUS";
 | |
| 
 | |
|     default:
 | |
|         return "";
 | |
|     }
 | |
| }
 | |
| 
 | |
| static const char *lasips2_write_reg_name(uint64_t addr)
 | |
| {
 | |
|     switch (addr & 0x0c) {
 | |
|     case REG_PS2_RESET:
 | |
|         return " PS2_RESET";
 | |
| 
 | |
|     case REG_PS2_XMTDATA:
 | |
|         return " PS2_XMTDATA";
 | |
| 
 | |
|     case REG_PS2_CONTROL:
 | |
|         return " PS2_CONTROL";
 | |
| 
 | |
|     default:
 | |
|         return "";
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void lasips2_update_irq(LASIPS2State *s)
 | |
| {
 | |
|     int level = s->int_status ? 1 : 0;
 | |
| 
 | |
|     trace_lasips2_intr(level);
 | |
|     qemu_set_irq(s->irq, level);
 | |
| }
 | |
| 
 | |
| static void lasips2_set_irq(void *opaque, int n, int level)
 | |
| {
 | |
|     LASIPS2State *s = LASIPS2(opaque);
 | |
| 
 | |
|     if (level) {
 | |
|         s->int_status |= BIT(n);
 | |
|     } else {
 | |
|         s->int_status &= ~BIT(n);
 | |
|     }
 | |
| 
 | |
|     lasips2_update_irq(s);
 | |
| }
 | |
| 
 | |
| static void lasips2_reg_write(void *opaque, hwaddr addr, uint64_t val,
 | |
|                               unsigned size)
 | |
| {
 | |
|     LASIPS2Port *lp = LASIPS2_PORT(opaque);
 | |
| 
 | |
|     trace_lasips2_reg_write(size, lp->id, addr,
 | |
|                             lasips2_write_reg_name(addr), val);
 | |
| 
 | |
|     switch (addr & 0xc) {
 | |
|     case REG_PS2_CONTROL:
 | |
|         lp->control = val;
 | |
|         break;
 | |
| 
 | |
|     case REG_PS2_XMTDATA:
 | |
|         if (lp->control & LASIPS2_CONTROL_LOOPBACK) {
 | |
|             lp->buf = val;
 | |
|             lp->loopback_rbne = true;
 | |
|             qemu_set_irq(lp->irq, 1);
 | |
|             break;
 | |
|         }
 | |
| 
 | |
|         if (lp->id) {
 | |
|             ps2_write_mouse(PS2_MOUSE_DEVICE(lp->ps2dev), val);
 | |
|         } else {
 | |
|             ps2_write_keyboard(PS2_KBD_DEVICE(lp->ps2dev), val);
 | |
|         }
 | |
|         break;
 | |
| 
 | |
|     case REG_PS2_RESET:
 | |
|         break;
 | |
| 
 | |
|     default:
 | |
|         qemu_log_mask(LOG_UNIMP, "%s: unknown register 0x%02" HWADDR_PRIx "\n",
 | |
|                       __func__, addr);
 | |
|         break;
 | |
|     }
 | |
| }
 | |
| 
 | |
| static uint64_t lasips2_reg_read(void *opaque, hwaddr addr, unsigned size)
 | |
| {
 | |
|     LASIPS2Port *lp = LASIPS2_PORT(opaque);
 | |
|     uint64_t ret = 0;
 | |
| 
 | |
|     switch (addr & 0xc) {
 | |
|     case REG_PS2_ID:
 | |
|         ret = lp->id;
 | |
|         break;
 | |
| 
 | |
|     case REG_PS2_RCVDATA:
 | |
|         if (lp->control & LASIPS2_CONTROL_LOOPBACK) {
 | |
|             lp->loopback_rbne = false;
 | |
|             qemu_set_irq(lp->irq, 0);
 | |
|             ret = lp->buf;
 | |
|             break;
 | |
|         }
 | |
| 
 | |
|         ret = ps2_read_data(lp->ps2dev);
 | |
|         break;
 | |
| 
 | |
|     case REG_PS2_CONTROL:
 | |
|         ret = lp->control;
 | |
|         break;
 | |
| 
 | |
|     case REG_PS2_STATUS:
 | |
|         ret = LASIPS2_STATUS_DATSHD | LASIPS2_STATUS_CLKSHD;
 | |
| 
 | |
|         if (lp->control & LASIPS2_CONTROL_DIAG) {
 | |
|             if (!(lp->control & LASIPS2_CONTROL_DATDIR)) {
 | |
|                 ret &= ~LASIPS2_STATUS_DATSHD;
 | |
|             }
 | |
| 
 | |
|             if (!(lp->control & LASIPS2_CONTROL_CLKDIR)) {
 | |
|                 ret &= ~LASIPS2_STATUS_CLKSHD;
 | |
|             }
 | |
|         }
 | |
| 
 | |
|         if (lp->control & LASIPS2_CONTROL_LOOPBACK) {
 | |
|             if (lp->loopback_rbne) {
 | |
|                 ret |= LASIPS2_STATUS_RBNE;
 | |
|             }
 | |
|         } else {
 | |
|             if (!ps2_queue_empty(lp->ps2dev)) {
 | |
|                 ret |= LASIPS2_STATUS_RBNE;
 | |
|             }
 | |
|         }
 | |
| 
 | |
|         if (lp->lasips2->int_status) {
 | |
|             ret |= LASIPS2_STATUS_CMPINTR;
 | |
|         }
 | |
|         break;
 | |
| 
 | |
|     default:
 | |
|         qemu_log_mask(LOG_UNIMP, "%s: unknown register 0x%02" HWADDR_PRIx "\n",
 | |
|                       __func__, addr);
 | |
|         break;
 | |
|     }
 | |
| 
 | |
|     trace_lasips2_reg_read(size, lp->id, addr,
 | |
|                            lasips2_read_reg_name(addr), ret);
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static const MemoryRegionOps lasips2_reg_ops = {
 | |
|     .read = lasips2_reg_read,
 | |
|     .write = lasips2_reg_write,
 | |
|     .impl = {
 | |
|         .min_access_size = 1,
 | |
|         .max_access_size = 4,
 | |
|     },
 | |
|     .endianness = DEVICE_BIG_ENDIAN,
 | |
| };
 | |
| 
 | |
| static void lasips2_realize(DeviceState *dev, Error **errp)
 | |
| {
 | |
|     LASIPS2State *s = LASIPS2(dev);
 | |
|     LASIPS2Port *lp;
 | |
| 
 | |
|     lp = LASIPS2_PORT(&s->kbd_port);
 | |
|     if (!(qdev_realize(DEVICE(lp), NULL, errp))) {
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     qdev_connect_gpio_out(DEVICE(lp), 0,
 | |
|                           qdev_get_gpio_in_named(dev, "lasips2-port-input-irq",
 | |
|                                                  lp->id));
 | |
| 
 | |
|     lp = LASIPS2_PORT(&s->mouse_port);
 | |
|     if (!(qdev_realize(DEVICE(lp), NULL, errp))) {
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     qdev_connect_gpio_out(DEVICE(lp), 0,
 | |
|                           qdev_get_gpio_in_named(dev, "lasips2-port-input-irq",
 | |
|                                                  lp->id));
 | |
| }
 | |
| 
 | |
| static void lasips2_init(Object *obj)
 | |
| {
 | |
|     LASIPS2State *s = LASIPS2(obj);
 | |
|     LASIPS2Port *lp;
 | |
| 
 | |
|     object_initialize_child(obj, "lasips2-kbd-port", &s->kbd_port,
 | |
|                             TYPE_LASIPS2_KBD_PORT);
 | |
|     object_initialize_child(obj, "lasips2-mouse-port", &s->mouse_port,
 | |
|                             TYPE_LASIPS2_MOUSE_PORT);
 | |
| 
 | |
|     lp = LASIPS2_PORT(&s->kbd_port);
 | |
|     sysbus_init_mmio(SYS_BUS_DEVICE(obj), &lp->reg);
 | |
|     lp = LASIPS2_PORT(&s->mouse_port);
 | |
|     sysbus_init_mmio(SYS_BUS_DEVICE(obj), &lp->reg);
 | |
| 
 | |
|     sysbus_init_irq(SYS_BUS_DEVICE(obj), &s->irq);
 | |
| 
 | |
|     qdev_init_gpio_in_named(DEVICE(obj), lasips2_set_irq,
 | |
|                             "lasips2-port-input-irq", 2);
 | |
| }
 | |
| 
 | |
| static void lasips2_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
| 
 | |
|     dc->realize = lasips2_realize;
 | |
|     dc->vmsd = &vmstate_lasips2;
 | |
|     set_bit(DEVICE_CATEGORY_INPUT, dc->categories);
 | |
| }
 | |
| 
 | |
| static const TypeInfo lasips2_info = {
 | |
|     .name          = TYPE_LASIPS2,
 | |
|     .parent        = TYPE_SYS_BUS_DEVICE,
 | |
|     .instance_init = lasips2_init,
 | |
|     .instance_size = sizeof(LASIPS2State),
 | |
|     .class_init    = lasips2_class_init,
 | |
| };
 | |
| 
 | |
| static void lasips2_port_set_irq(void *opaque, int n, int level)
 | |
| {
 | |
|     LASIPS2Port *s = LASIPS2_PORT(opaque);
 | |
| 
 | |
|     qemu_set_irq(s->irq, level);
 | |
| }
 | |
| 
 | |
| static void lasips2_port_realize(DeviceState *dev, Error **errp)
 | |
| {
 | |
|     LASIPS2Port *s = LASIPS2_PORT(dev);
 | |
| 
 | |
|     qdev_connect_gpio_out(DEVICE(s->ps2dev), PS2_DEVICE_IRQ,
 | |
|                           qdev_get_gpio_in_named(dev, "ps2-input-irq", 0));
 | |
| }
 | |
| 
 | |
| static void lasips2_port_init(Object *obj)
 | |
| {
 | |
|     LASIPS2Port *s = LASIPS2_PORT(obj);
 | |
| 
 | |
|     qdev_init_gpio_out(DEVICE(obj), &s->irq, 1);
 | |
|     qdev_init_gpio_in_named(DEVICE(obj), lasips2_port_set_irq,
 | |
|                             "ps2-input-irq", 1);
 | |
| }
 | |
| 
 | |
| static void lasips2_port_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
| 
 | |
|     dc->realize = lasips2_port_realize;
 | |
| }
 | |
| 
 | |
| static const TypeInfo lasips2_port_info = {
 | |
|     .name          = TYPE_LASIPS2_PORT,
 | |
|     .parent        = TYPE_DEVICE,
 | |
|     .instance_init = lasips2_port_init,
 | |
|     .instance_size = sizeof(LASIPS2Port),
 | |
|     .class_init    = lasips2_port_class_init,
 | |
|     .class_size    = sizeof(LASIPS2PortDeviceClass),
 | |
|     .abstract      = true,
 | |
| };
 | |
| 
 | |
| static void lasips2_kbd_port_realize(DeviceState *dev, Error **errp)
 | |
| {
 | |
|     LASIPS2KbdPort *s = LASIPS2_KBD_PORT(dev);
 | |
|     LASIPS2Port *lp = LASIPS2_PORT(dev);
 | |
|     LASIPS2PortDeviceClass *lpdc = LASIPS2_PORT_GET_CLASS(lp);
 | |
| 
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->kbd), errp)) {
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     lp->ps2dev = PS2_DEVICE(&s->kbd);
 | |
|     lpdc->parent_realize(dev, errp);
 | |
| }
 | |
| 
 | |
| static void lasips2_kbd_port_init(Object *obj)
 | |
| {
 | |
|     LASIPS2KbdPort *s = LASIPS2_KBD_PORT(obj);
 | |
|     LASIPS2Port *lp = LASIPS2_PORT(obj);
 | |
| 
 | |
|     memory_region_init_io(&lp->reg, obj, &lasips2_reg_ops, lp, "lasips2-kbd",
 | |
|                           0x100);
 | |
| 
 | |
|     object_initialize_child(obj, "kbd", &s->kbd, TYPE_PS2_KBD_DEVICE);
 | |
| 
 | |
|     lp->id = 0;
 | |
|     lp->lasips2 = container_of(s, LASIPS2State, kbd_port);
 | |
| }
 | |
| 
 | |
| static void lasips2_kbd_port_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     LASIPS2PortDeviceClass *lpdc = LASIPS2_PORT_CLASS(klass);
 | |
| 
 | |
|     device_class_set_parent_realize(dc, lasips2_kbd_port_realize,
 | |
|                                     &lpdc->parent_realize);
 | |
| }
 | |
| 
 | |
| static const TypeInfo lasips2_kbd_port_info = {
 | |
|     .name          = TYPE_LASIPS2_KBD_PORT,
 | |
|     .parent        = TYPE_LASIPS2_PORT,
 | |
|     .instance_size = sizeof(LASIPS2KbdPort),
 | |
|     .instance_init = lasips2_kbd_port_init,
 | |
|     .class_init    = lasips2_kbd_port_class_init,
 | |
| };
 | |
| 
 | |
| static void lasips2_mouse_port_realize(DeviceState *dev, Error **errp)
 | |
| {
 | |
|     LASIPS2MousePort *s = LASIPS2_MOUSE_PORT(dev);
 | |
|     LASIPS2Port *lp = LASIPS2_PORT(dev);
 | |
|     LASIPS2PortDeviceClass *lpdc = LASIPS2_PORT_GET_CLASS(lp);
 | |
| 
 | |
|     if (!sysbus_realize(SYS_BUS_DEVICE(&s->mouse), errp)) {
 | |
|         return;
 | |
|     }
 | |
| 
 | |
|     lp->ps2dev = PS2_DEVICE(&s->mouse);
 | |
|     lpdc->parent_realize(dev, errp);
 | |
| }
 | |
| 
 | |
| static void lasips2_mouse_port_init(Object *obj)
 | |
| {
 | |
|     LASIPS2MousePort *s = LASIPS2_MOUSE_PORT(obj);
 | |
|     LASIPS2Port *lp = LASIPS2_PORT(obj);
 | |
| 
 | |
|     memory_region_init_io(&lp->reg, obj, &lasips2_reg_ops, lp, "lasips2-mouse",
 | |
|                           0x100);
 | |
| 
 | |
|     object_initialize_child(obj, "mouse", &s->mouse, TYPE_PS2_MOUSE_DEVICE);
 | |
| 
 | |
|     lp->id = 1;
 | |
|     lp->lasips2 = container_of(s, LASIPS2State, mouse_port);
 | |
| }
 | |
| 
 | |
| static void lasips2_mouse_port_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     LASIPS2PortDeviceClass *lpdc = LASIPS2_PORT_CLASS(klass);
 | |
| 
 | |
|     device_class_set_parent_realize(dc, lasips2_mouse_port_realize,
 | |
|                                     &lpdc->parent_realize);
 | |
| }
 | |
| 
 | |
| static const TypeInfo lasips2_mouse_port_info = {
 | |
|     .name          = TYPE_LASIPS2_MOUSE_PORT,
 | |
|     .parent        = TYPE_LASIPS2_PORT,
 | |
|     .instance_size = sizeof(LASIPS2MousePort),
 | |
|     .instance_init = lasips2_mouse_port_init,
 | |
|     .class_init    = lasips2_mouse_port_class_init,
 | |
| };
 | |
| 
 | |
| static void lasips2_register_types(void)
 | |
| {
 | |
|     type_register_static(&lasips2_info);
 | |
|     type_register_static(&lasips2_port_info);
 | |
|     type_register_static(&lasips2_kbd_port_info);
 | |
|     type_register_static(&lasips2_mouse_port_info);
 | |
| }
 | |
| 
 | |
| type_init(lasips2_register_types)
 |