qapi/error: Check format string argument in error_*prepend()
[qemu/armbru.git] / hw / m68k / next-kbd.c
blob2dff87be151b98241b2f8f95167e904c603e9ea1
1 /*
2 * QEMU NeXT Keyboard/Mouse emulation
4 * Copyright (c) 2011 Bryce Lanham
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:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
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.
26 * This is admittedly hackish, but works well enough for basic input. Mouse
27 * support will be added once we can boot something that needs the mouse.
30 #include "qemu/osdep.h"
31 #include "qemu/log.h"
32 #include "exec/address-spaces.h"
33 #include "hw/hw.h"
34 #include "hw/sysbus.h"
35 #include "hw/m68k/next-cube.h"
36 #include "ui/console.h"
37 #include "sysemu/sysemu.h"
38 #include "migration/vmstate.h"
40 #define NEXTKBD(obj) OBJECT_CHECK(NextKBDState, (obj), TYPE_NEXTKBD)
42 /* following defintions from next68k netbsd */
43 #define CSR_INT 0x00800000
44 #define CSR_DATA 0x00400000
46 #define KD_KEYMASK 0x007f
47 #define KD_DIRECTION 0x0080 /* pressed or released */
48 #define KD_CNTL 0x0100
49 #define KD_LSHIFT 0x0200
50 #define KD_RSHIFT 0x0400
51 #define KD_LCOMM 0x0800
52 #define KD_RCOMM 0x1000
53 #define KD_LALT 0x2000
54 #define KD_RALT 0x4000
55 #define KD_VALID 0x8000 /* only set for scancode keys ? */
56 #define KD_MODS 0x4f00
58 #define KBD_QUEUE_SIZE 256
60 typedef struct {
61 uint8_t data[KBD_QUEUE_SIZE];
62 int rptr, wptr, count;
63 } KBDQueue;
66 typedef struct NextKBDState {
67 SysBusDevice sbd;
68 MemoryRegion mr;
69 KBDQueue queue;
70 uint16_t shift;
71 } NextKBDState;
73 static void queue_code(void *opaque, int code);
75 /* lots of magic numbers here */
76 static uint32_t kbd_read_byte(void *opaque, hwaddr addr)
78 switch (addr & 0x3) {
79 case 0x0: /* 0xe000 */
80 return 0x80 | 0x20;
82 case 0x1: /* 0xe001 */
83 return 0x80 | 0x40 | 0x20 | 0x10;
85 case 0x2: /* 0xe002 */
86 /* returning 0x40 caused mach to hang */
87 return 0x10 | 0x2 | 0x1;
89 default:
90 qemu_log_mask(LOG_UNIMP, "NeXT kbd read byte %"HWADDR_PRIx"\n", addr);
93 return 0;
96 static uint32_t kbd_read_word(void *opaque, hwaddr addr)
98 qemu_log_mask(LOG_UNIMP, "NeXT kbd read word %"HWADDR_PRIx"\n", addr);
99 return 0;
102 /* even more magic numbers */
103 static uint32_t kbd_read_long(void *opaque, hwaddr addr)
105 int key = 0;
106 NextKBDState *s = NEXTKBD(opaque);
107 KBDQueue *q = &s->queue;
109 switch (addr & 0xf) {
110 case 0x0: /* 0xe000 */
111 return 0xA0F09300;
113 case 0x8: /* 0xe008 */
114 /* get keycode from buffer */
115 if (q->count > 0) {
116 key = q->data[q->rptr];
117 if (++q->rptr == KBD_QUEUE_SIZE) {
118 q->rptr = 0;
121 q->count--;
123 if (s->shift) {
124 key |= s->shift;
127 if (key & 0x80) {
128 return 0;
129 } else {
130 return 0x10000000 | KD_VALID | key;
132 } else {
133 return 0;
136 default:
137 qemu_log_mask(LOG_UNIMP, "NeXT kbd read long %"HWADDR_PRIx"\n", addr);
138 return 0;
142 static uint64_t kbd_readfn(void *opaque, hwaddr addr, unsigned size)
144 switch (size) {
145 case 1:
146 return kbd_read_byte(opaque, addr);
147 case 2:
148 return kbd_read_word(opaque, addr);
149 case 4:
150 return kbd_read_long(opaque, addr);
151 default:
152 g_assert_not_reached();
156 static void kbd_writefn(void *opaque, hwaddr addr, uint64_t value,
157 unsigned size)
159 qemu_log_mask(LOG_UNIMP, "NeXT kbd write: size=%u addr=0x%"HWADDR_PRIx
160 "val=0x%"PRIx64"\n", size, addr, value);
163 static const MemoryRegionOps kbd_ops = {
164 .read = kbd_readfn,
165 .write = kbd_writefn,
166 .valid.min_access_size = 1,
167 .valid.max_access_size = 4,
168 .endianness = DEVICE_NATIVE_ENDIAN,
171 static void nextkbd_event(void *opaque, int ch)
174 * Will want to set vars for caps/num lock
175 * if (ch & 0x80) -> key release
176 * there's also e0 escaped scancodes that might need to be handled
178 queue_code(opaque, ch);
181 static const unsigned char next_keycodes[128] = {
182 0x00, 0x49, 0x4A, 0x4B, 0x4C, 0x4D, 0x50, 0x4F,
183 0x4E, 0x1E, 0x1F, 0x20, 0x1D, 0x1C, 0x1B, 0x00,
184 0x42, 0x43, 0x44, 0x45, 0x48, 0x47, 0x46, 0x06,
185 0x07, 0x08, 0x00, 0x00, 0x2A, 0x00, 0x39, 0x3A,
186 0x3B, 0x3C, 0x3D, 0x40, 0x3F, 0x3E, 0x2D, 0x2C,
187 0x2B, 0x26, 0x00, 0x00, 0x31, 0x32, 0x33, 0x34,
188 0x35, 0x37, 0x36, 0x2e, 0x2f, 0x30, 0x00, 0x00,
189 0x00, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
190 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
191 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
192 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
193 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
196 static void queue_code(void *opaque, int code)
198 NextKBDState *s = NEXTKBD(opaque);
199 KBDQueue *q = &s->queue;
200 int key = code & KD_KEYMASK;
201 int release = code & 0x80;
202 static int ext;
204 if (code == 0xE0) {
205 ext = 1;
208 if (code == 0x2A || code == 0x1D || code == 0x36) {
209 if (code == 0x2A) {
210 s->shift = KD_LSHIFT;
211 } else if (code == 0x36) {
212 s->shift = KD_RSHIFT;
213 ext = 0;
214 } else if (code == 0x1D && !ext) {
215 s->shift = KD_LCOMM;
216 } else if (code == 0x1D && ext) {
217 ext = 0;
218 s->shift = KD_RCOMM;
220 return;
221 } else if (code == (0x2A | 0x80) || code == (0x1D | 0x80) ||
222 code == (0x36 | 0x80)) {
223 s->shift = 0;
224 return;
227 if (q->count >= KBD_QUEUE_SIZE) {
228 return;
231 q->data[q->wptr] = next_keycodes[key] | release;
233 if (++q->wptr == KBD_QUEUE_SIZE) {
234 q->wptr = 0;
237 q->count++;
240 * might need to actually trigger the NeXT irq, but as the keyboard works
241 * at the moment, I'll worry about it later
243 /* s->update_irq(s->update_arg, 1); */
246 static void nextkbd_reset(DeviceState *dev)
248 NextKBDState *nks = NEXTKBD(dev);
250 memset(&nks->queue, 0, sizeof(KBDQueue));
251 nks->shift = 0;
254 static void nextkbd_realize(DeviceState *dev, Error **errp)
256 NextKBDState *s = NEXTKBD(dev);
258 memory_region_init_io(&s->mr, OBJECT(dev), &kbd_ops, s, "next.kbd", 0x1000);
259 sysbus_init_mmio(SYS_BUS_DEVICE(dev), &s->mr);
261 qemu_add_kbd_event_handler(nextkbd_event, s);
264 static const VMStateDescription nextkbd_vmstate = {
265 .name = TYPE_NEXTKBD,
266 .unmigratable = 1, /* TODO: Implement this when m68k CPU is migratable */
269 static void nextkbd_class_init(ObjectClass *oc, void *data)
271 DeviceClass *dc = DEVICE_CLASS(oc);
273 set_bit(DEVICE_CATEGORY_INPUT, dc->categories);
274 dc->vmsd = &nextkbd_vmstate;
275 dc->realize = nextkbd_realize;
276 dc->reset = nextkbd_reset;
279 static const TypeInfo nextkbd_info = {
280 .name = TYPE_NEXTKBD,
281 .parent = TYPE_SYS_BUS_DEVICE,
282 .instance_size = sizeof(NextKBDState),
283 .class_init = nextkbd_class_init,
286 static void nextkbd_register_types(void)
288 type_register_static(&nextkbd_info);
291 type_init(nextkbd_register_types)