/* * QEMU ADB support * * Copyright (c) 2004 Fabrice Bellard * * 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 "hw/input/adb.h" #include "hw/qdev-properties.h" #include "migration/vmstate.h" #include "qemu/module.h" #include "qemu/timer.h" #include "adb-internal.h" #include "trace.h" /* error codes */ #define ADB_RET_NOTPRESENT (-2) static const char *adb_commands[] = { "RESET", "FLUSH", "(Reserved 0x2)", "(Reserved 0x3)", "Reserved (0x4)", "(Reserved 0x5)", "(Reserved 0x6)", "(Reserved 0x7)", "LISTEN r0", "LISTEN r1", "LISTEN r2", "LISTEN r3", "TALK r0", "TALK r1", "TALK r2", "TALK r3", }; static void adb_device_reset(ADBDevice *d) { qdev_reset_all(DEVICE(d)); } static int do_adb_request(ADBBusState *s, uint8_t *obuf, const uint8_t *buf, int len) { ADBDevice *d; ADBDeviceClass *adc; int devaddr, cmd, olen, i; cmd = buf[0] & 0xf; if (cmd == ADB_BUSRESET) { for (i = 0; i < s->nb_devices; i++) { d = s->devices[i]; adb_device_reset(d); } s->status = 0; return 0; } s->pending = 0; for (i = 0; i < s->nb_devices; i++) { d = s->devices[i]; adc = ADB_DEVICE_GET_CLASS(d); if (adc->devhasdata(d)) { s->pending |= (1 << d->devaddr); } } s->status = 0; devaddr = buf[0] >> 4; for (i = 0; i < s->nb_devices; i++) { d = s->devices[i]; adc = ADB_DEVICE_GET_CLASS(d); if (d->devaddr == devaddr) { olen = adc->devreq(d, obuf, buf, len); if (!olen) { s->status |= ADB_STATUS_BUSTIMEOUT; } return olen; } } s->status |= ADB_STATUS_BUSTIMEOUT; return ADB_RET_NOTPRESENT; } int adb_request(ADBBusState *s, uint8_t *obuf, const uint8_t *buf, int len) { int ret; trace_adb_bus_request(buf[0] >> 4, adb_commands[buf[0] & 0xf], len); assert(s->autopoll_blocked); ret = do_adb_request(s, obuf, buf, len); trace_adb_bus_request_done(buf[0] >> 4, adb_commands[buf[0] & 0xf], ret); return ret; } int adb_poll(ADBBusState *s, uint8_t *obuf, uint16_t poll_mask) { ADBDevice *d; int olen, i; uint8_t buf[1]; olen = 0; for (i = 0; i < s->nb_devices; i++) { if (s->poll_index >= s->nb_devices) { s->poll_index = 0; } d = s->devices[s->poll_index]; if ((1 << d->devaddr) & poll_mask) { buf[0] = ADB_READREG | (d->devaddr << 4); olen = do_adb_request(s, obuf + 1, buf, 1); /* if there is data, we poll again the same device */ if (olen > 0) { s->status |= ADB_STATUS_POLLREPLY; obuf[0] = buf[0]; olen++; return olen; } } s->poll_index++; } return olen; } void adb_set_autopoll_enabled(ADBBusState *s, bool enabled) { if (s->autopoll_enabled != enabled) { s->autopoll_enabled = enabled; if (s->autopoll_enabled) { timer_mod(s->autopoll_timer, qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + s->autopoll_rate_ms); } else { timer_del(s->autopoll_timer); } } } void adb_set_autopoll_rate_ms(ADBBusState *s, int rate_ms) { s->autopoll_rate_ms = rate_ms; if (s->autopoll_enabled) { timer_mod(s->autopoll_timer, qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + s->autopoll_rate_ms); } } void adb_set_autopoll_mask(ADBBusState *s, uint16_t mask) { if (s->autopoll_mask != mask) { s->autopoll_mask = mask; if (s->autopoll_enabled && s->autopoll_mask) { timer_mod(s->autopoll_timer, qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + s->autopoll_rate_ms); } else { timer_del(s->autopoll_timer); } } } void adb_autopoll_block(ADBBusState *s) { s->autopoll_blocked = true; trace_adb_bus_autopoll_block(s->autopoll_blocked); if (s->autopoll_enabled) { timer_del(s->autopoll_timer); } } void adb_autopoll_unblock(ADBBusState *s) { s->autopoll_blocked = false; trace_adb_bus_autopoll_block(s->autopoll_blocked); if (s->autopoll_enabled) { timer_mod(s->autopoll_timer, qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + s->autopoll_rate_ms); } } static void adb_autopoll(void *opaque) { ADBBusState *s = opaque; if (!s->autopoll_blocked) { trace_adb_bus_autopoll_cb(s->autopoll_mask); s->autopoll_cb(s->autopoll_cb_opaque); trace_adb_bus_autopoll_cb_done(s->autopoll_mask); } timer_mod(s->autopoll_timer, qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + s->autopoll_rate_ms); } void adb_register_autopoll_callback(ADBBusState *s, void (*cb)(void *opaque), void *opaque) { s->autopoll_cb = cb; s->autopoll_cb_opaque = opaque; } static const VMStateDescription vmstate_adb_bus = { .name = "adb_bus", .version_id = 0, .minimum_version_id = 0, .fields = (VMStateField[]) { VMSTATE_TIMER_PTR(autopoll_timer, ADBBusState), VMSTATE_BOOL(autopoll_enabled, ADBBusState), VMSTATE_UINT8(autopoll_rate_ms, ADBBusState), VMSTATE_UINT16(autopoll_mask, ADBBusState), VMSTATE_BOOL(autopoll_blocked, ADBBusState), VMSTATE_END_OF_LIST() } }; static void adb_bus_reset(BusState *qbus) { ADBBusState *adb_bus = ADB_BUS(qbus); adb_bus->autopoll_enabled = false; adb_bus->autopoll_mask = 0xffff; adb_bus->autopoll_rate_ms = 20; } static void adb_bus_realize(BusState *qbus, Error **errp) { ADBBusState *adb_bus = ADB_BUS(qbus); adb_bus->autopoll_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL, adb_autopoll, adb_bus); vmstate_register(NULL, -1, &vmstate_adb_bus, adb_bus); } static void adb_bus_unrealize(BusState *qbus) { ADBBusState *adb_bus = ADB_BUS(qbus); timer_del(adb_bus->autopoll_timer); vmstate_unregister(NULL, &vmstate_adb_bus, adb_bus); } static void adb_bus_class_init(ObjectClass *klass, void *data) { BusClass *k = BUS_CLASS(klass); k->realize = adb_bus_realize; k->unrealize = adb_bus_unrealize; k->reset = adb_bus_reset; } static const TypeInfo adb_bus_type_info = { .name = TYPE_ADB_BUS, .parent = TYPE_BUS, .instance_size = sizeof(ADBBusState), .class_init = adb_bus_class_init, }; const VMStateDescription vmstate_adb_device = { .name = "adb_device", .version_id = 0, .minimum_version_id = 0, .fields = (VMStateField[]) { VMSTATE_INT32(devaddr, ADBDevice), VMSTATE_INT32(handler, ADBDevice), VMSTATE_END_OF_LIST() } }; static void adb_device_realizefn(DeviceState *dev, Error **errp) { ADBDevice *d = ADB_DEVICE(dev); ADBBusState *bus = ADB_BUS(qdev_get_parent_bus(dev)); if (bus->nb_devices >= MAX_ADB_DEVICES) { return; } bus->devices[bus->nb_devices++] = d; } static void adb_device_class_init(ObjectClass *oc, void *data) { DeviceClass *dc = DEVICE_CLASS(oc); dc->realize = adb_device_realizefn; dc->bus_type = TYPE_ADB_BUS; } static const TypeInfo adb_device_type_info = { .name = TYPE_ADB_DEVICE, .parent = TYPE_DEVICE, .class_size = sizeof(ADBDeviceClass), .instance_size = sizeof(ADBDevice), .abstract = true, .class_init = adb_device_class_init, }; static void adb_register_types(void) { type_register_static(&adb_bus_type_info); type_register_static(&adb_device_type_info); } type_init(adb_register_types)