On 6/28/19 8:15 PM, Thomas Huth wrote:
> It is likely still quite incomplete (e.g. mouse and interrupts are not
> implemented yet), but it is good enough for keyboard input at the firmware
> monitor.
> This code has been taken from Bryce Lanham's GSoC 2011 NeXT branch at
>
> https://github.com/blanham/qemu-NeXT/blob/next-cube/hw/next-kbd.c
Please use commit sha1 in link.
> and altered to fit the latest interface of the current QEMU (e.g. to use
> memory_region_init_io() instead of cpu_register_physical_memory()).
>
> Signed-off-by: Thomas Huth <h...@tuxfamily.org>
> ---
> hw/m68k/Makefile.objs | 1 +
> hw/m68k/next-kbd.c | 320 ++++++++++++++++++++++++++++++++++++
> include/hw/m68k/next-cube.h | 3 +
> 3 files changed, 324 insertions(+)
> create mode 100644 hw/m68k/next-kbd.c
>
> diff --git a/hw/m68k/Makefile.objs b/hw/m68k/Makefile.objs
> index 482f8477b4..688002cac1 100644
> --- a/hw/m68k/Makefile.objs
> +++ b/hw/m68k/Makefile.objs
> @@ -1,2 +1,3 @@
> obj-$(CONFIG_AN5206) += an5206.o mcf5206.o
> obj-$(CONFIG_MCF5208) += mcf5208.o mcf_intc.o
> +obj-$(CONFIG_NEXTCUBE) += next-kbd.o
> diff --git a/hw/m68k/next-kbd.c b/hw/m68k/next-kbd.c
> new file mode 100644
> index 0000000000..73e90f9b62
> --- /dev/null
> +++ b/hw/m68k/next-kbd.c
> @@ -0,0 +1,320 @@
> +/*
> + * QEMU NeXT Keyboard/Mouse emulation
> + *
> + * Copyright (c) 2011 Bryce Lanham
> + *
> + * 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.
> + */
> +
> +/*
> + * This is admittedly hackish, but works well enough for basic input. Mouse
> + * support will be added once we can boot something that needs the mouse.
> + */
> +
> +#include "qemu/osdep.h"
> +#include "qemu/log.h"
> +#include "exec/address-spaces.h"
> +#include "hw/hw.h"
> +#include "hw/sysbus.h"
> +#include "hw/m68k/next-cube.h"
> +#include "ui/console.h"
> +#include "sysemu/sysemu.h"
> +
> +#define TYPE_NEXTKBD "next-kbd"
> +#define NEXTKBD(obj) OBJECT_CHECK(NextKBDState, (obj), TYPE_NEXTKBD)
> +
> +/* following defintions from next68k netbsd */
> +#define CSR_INT 0x00800000
> +#define CSR_DATA 0x00400000
> +
> +#define KD_KEYMASK 0x007f
> +#define KD_DIRECTION 0x0080 /* pressed or released */
> +#define KD_CNTL 0x0100
> +#define KD_LSHIFT 0x0200
> +#define KD_RSHIFT 0x0400
> +#define KD_LCOMM 0x0800
> +#define KD_RCOMM 0x1000
> +#define KD_LALT 0x2000
> +#define KD_RALT 0x4000
> +#define KD_VALID 0x8000 /* only set for scancode keys ? */
> +#define KD_MODS 0x4f00
> +
> +#define KBD_QUEUE_SIZE 256
> +
> +typedef struct {
> + uint8_t data[KBD_QUEUE_SIZE];
> + int rptr, wptr, count;
> +} KBDQueue;
> +
> +
> +typedef struct NextKBDState {
> + SysBusDevice sbd;
> + MemoryRegion mr;
> + KBDQueue queue;
> + uint16_t shift;
> +} NextKBDState;
> +
> +static void queue_code(void *opaque, int code);
> +
> +/* lots of magic numbers here */
> +static uint32_t kbd_read_byte(void *opaque, hwaddr addr)
> +{
> + switch (addr & 0x3) {
> + case 0x0: /* 0xe000 */
> + return 0x80 | 0x20;
> +
> + case 0x1: /* 0xe001 */
> + return 0x80 | 0x40 | 0x20 | 0x10;
> +
> + case 0x2: /* 0xe002 */
> + /* returning 0x40 caused mach to hang */
> + return 0x10 | 0x2 | 0x1;
> +
> + default:
> + qemu_log_mask(LOG_UNIMP, "NeXT kbd read byte %"HWADDR_PRIx"\n",
> addr);
> + }
> +
> + return 0;
> +}
> +
> +static uint32_t kbd_read_word(void *opaque, hwaddr addr)
> +{
> + qemu_log_mask(LOG_UNIMP, "NeXT kbd read word %"HWADDR_PRIx"\n", addr);
This sounds odd... a bus working in 32-bit/8-bit but not 16...
> + return 0;
> +}
> +
> +/* even more magic numbers */
> +static uint32_t kbd_read_long(void *opaque, hwaddr addr)
> +{
> + int key = 0;
> + NextKBDState *s = NEXTKBD(opaque);
> + KBDQueue *q = &s->queue;
> +
> + switch (addr & 0xf) {
> + case 0x0: /* 0xe000 */
> + return 0xA0F09300;
> +
> + case 0x8: /* 0xe008 */
> + /* get keycode from buffer */
> + if (q->count > 0) {
> + key = q->data[q->rptr];
> + if (++q->rptr == KBD_QUEUE_SIZE) {
> + q->rptr = 0;
> + }
> +
> + q->count--;
> +
> + if (s->shift) {
> + key |= s->shift;
> + }
> +
> + if (key & 0x80) {
> + return 0;
> + } else {
> + return 0x10000000 | KD_VALID | key;
> + }
> + } else {
> + return 0;
> + }
> +
> + default:
> + qemu_log_mask(LOG_UNIMP, "NeXT kbd read long %"HWADDR_PRIx"\n",
> addr);
> + return 0;
> + }
> +}
> +
> +static void kbd_write_byte(void *opaque, hwaddr addr, uint32_t val)
> +{
> + qemu_log_mask(LOG_UNIMP, "NeXT kbd write byte %"HWADDR_PRIx"\n", addr);
> +}
> +static void kbd_write_word(void *opaque, hwaddr addr, uint32_t val)
> +{
> + qemu_log_mask(LOG_UNIMP, "NeXT kbd write addr %"HWADDR_PRIx"\n", addr);
> +}
> +static void kbd_write_long(void *opaque, hwaddr addr, uint32_t val)
> +{
> + qemu_log_mask(LOG_UNIMP, "NeXT kbd write long %"HWADDR_PRIx"\n", addr);
> +}
> +
> +static uint64_t kbd_readfn(void *opaque, hwaddr addr, unsigned size)
> +{
> + switch (size) {
> + case 1:
> + return kbd_read_byte(opaque, addr);
> + case 2:
> + return kbd_read_word(opaque, addr);
> + case 4:
> + return kbd_read_long(opaque, addr);
> + default:
> + g_assert_not_reached();
> + }
> +}
> +
> +static void kbd_writefn(void *opaque, hwaddr addr, uint64_t value,
> + unsigned size)
> +{
> + switch (size) {
> + case 1:
> + kbd_write_byte(opaque, addr, value);
> + break;
> + case 2:
> + kbd_write_word(opaque, addr, value);
> + break;
> + case 4:
> + kbd_write_long(opaque, addr, value);
> + break;
> + default:
> + g_assert_not_reached();
> + }
Well, you can replace this by:
qemu_log_mask(LOG_UNIMP,
"NeXT kbd write size:%u 0x%"HWADDR_PRIx"\n",
size, addr);
and kill the kbd_write_*() functions and the assert (never
reached since .valid.max_access_size = 4).
> +}
> +
> +static const MemoryRegionOps kbd_ops = {
> + .read = kbd_readfn,
> + .write = kbd_writefn,
> + .valid.min_access_size = 1,
> + .valid.max_access_size = 4,
> + .endianness = DEVICE_NATIVE_ENDIAN,
> +};
> +
> +static void nextkbd_event(void *opaque, int ch)
> +{
> + /*
> + * Will want to set vars for caps/num lock
> + * if (ch & 0x80) -> key release
> + * there's also e0 escaped scancodes that might need to be handled
> + */
> + queue_code(opaque, ch);
> +}
> +
> +static const unsigned char next_keycodes[128] = {
> + 0x00, 0x49, 0x4A, 0x4B, 0x4C, 0x4D, 0x50, 0x4F,
> + 0x4E, 0x1E, 0x1F, 0x20, 0x1D, 0x1C, 0x1B, 0x00,
> + 0x42, 0x43, 0x44, 0x45, 0x48, 0x47, 0x46, 0x06,
> + 0x07, 0x08, 0x00, 0x00, 0x2A, 0x00, 0x39, 0x3A,
> + 0x3B, 0x3C, 0x3D, 0x40, 0x3F, 0x3E, 0x2D, 0x2C,
> + 0x2B, 0x26, 0x00, 0x00, 0x31, 0x32, 0x33, 0x34,
> + 0x35, 0x37, 0x36, 0x2e, 0x2f, 0x30, 0x00, 0x00,
> + 0x00, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
> + 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
> + 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
> + 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
> +};
> +
> +static void queue_code(void *opaque, int code)
> +{
> + NextKBDState *s = NEXTKBD(opaque);
> + KBDQueue *q = &s->queue;
> + int key = code & 0x7F;
Here 0x7f is ARRAY_SIZE(next_keycodes) - 1, ok.
Isn't it the KD_KEYMASK definition from above then?
> + int release = code & 0x80;
> + static int ext;
> +
> + if (code == 0xE0) {
> + ext = 1;
> + }
> +
> + if (code == 0x2A || code == 0x1D || code == 0x36) {
> + if (code == 0x2A) {
> + s->shift = KD_LSHIFT;
> + } else if (code == 0x36) {
> + s->shift = KD_RSHIFT;
> + ext = 0;
> + } else if (code == 0x1D && !ext) {
> + s->shift = KD_LCOMM;
> + } else if (code == 0x1D && ext) {
> + ext = 0;
> + s->shift = KD_RCOMM;
> + }
> + return;
> + } else if (code == (0x2A | 0x80) || code == (0x1D | 0x80) ||
> + code == (0x36 | 0x80)) {
> + s->shift = 0;
> + return;
> + }
> +
> + if (q->count >= KBD_QUEUE_SIZE) {
> + return;
> + }
> +
> + q->data[q->wptr] = next_keycodes[key] | release;
> +
> + if (++q->wptr == KBD_QUEUE_SIZE) {
> + q->wptr = 0;
> + }
> +
> + q->count++;
> +
> + /*
> + * might need to actually trigger the NeXT irq, but as the keyboard works
> + * at the moment, I'll worry about it later
> + */
> + /* s->update_irq(s->update_arg, 1); */
> +}
> +
> +static void nextkbd_reset(DeviceState *dev)
> +{
> + NextKBDState *nks = NEXTKBD(dev);
> +
> + memset(&nks->queue, 0, sizeof(KBDQueue));
> + nks->shift = 0;
> +}
> +
> +static void nextkbd_realize(DeviceState *dev, Error **errp)
> +{
> + NextKBDState *s = NEXTKBD(dev);
> +
> + memory_region_init_io(&s->mr, OBJECT(dev), &kbd_ops, s, "next.kbd",
> 0x1000);
> +
> + qemu_add_kbd_event_handler(nextkbd_event, s);
> +}
> +
> +static void nextkbd_class_init(ObjectClass *oc, void *data)
> +{
> + DeviceClass *dc = DEVICE_CLASS(oc);
> +
> + set_bit(DEVICE_CATEGORY_INPUT, dc->categories);
> + dc->realize = nextkbd_realize;
> + dc->reset = nextkbd_reset;
> +}
> +
> +static const TypeInfo nextkbd_info = {
> + .name = TYPE_NEXTKBD,
> + .parent = TYPE_SYS_BUS_DEVICE,
> + .instance_size = sizeof(NextKBDState),
> + .class_init = nextkbd_class_init,
> +};
> +
> +static void nextkbd_register_types(void)
> +{
> + type_register_static(&nextkbd_info);
> +}
> +
> +type_init(nextkbd_register_types)
> +
> +void nextkbd_init(void)
> +{
> + DeviceState *dev;
> + NextKBDState *nks;
> +
> + dev = qdev_create(NULL, TYPE_NEXTKBD);
> + qdev_init_nofail(dev);
> +
> + nks = NEXTKBD(dev);
> + memory_region_add_subregion(get_system_memory(), 0x200e000, &nks->mr);
0x200e000 -> 0x0200e000 :)
> +}
Again, nextkbd_init() is board-specific code.
Could you move this function there?
Thanks,
Phil.
> diff --git a/include/hw/m68k/next-cube.h b/include/hw/m68k/next-cube.h
> index cf07243bda..88e94f6595 100644
> --- a/include/hw/m68k/next-cube.h
> +++ b/include/hw/m68k/next-cube.h
> @@ -5,4 +5,7 @@
> /* next-fb.c */
> void nextfb_init(void);
>
> +/* next-kbd.c */
> +void nextkbd_init(void);
> +
> #endif /* NEXT_CUBE_H */
>
