From patchwork Fri Jan 18 06:33:00 2013 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Dante X-Patchwork-Id: 213491 Return-Path: X-Original-To: incoming@patchwork.ozlabs.org Delivered-To: patchwork-incoming@bilbo.ozlabs.org Received: from lists.gnu.org (lists.gnu.org [208.118.235.17]) (using TLSv1 with cipher AES256-SHA (256/256 bits)) (Client did not present a certificate) by ozlabs.org (Postfix) with ESMTPS id E22A82C0087 for ; Fri, 18 Jan 2013 17:33:38 +1100 (EST) Received: from localhost ([::1]:37652 helo=lists.gnu.org) by lists.gnu.org with esmtp (Exim 4.71) (envelope-from ) id 1Tw5WC-0000O8-T0 for incoming@patchwork.ozlabs.org; Fri, 18 Jan 2013 01:33:36 -0500 Received: from eggs.gnu.org ([208.118.235.92]:39966) by lists.gnu.org with esmtp (Exim 4.71) (envelope-from ) id 1Tw5Vw-0000A7-Sg for qemu-devel@nongnu.org; Fri, 18 Jan 2013 01:33:23 -0500 Received: from Debian-exim by eggs.gnu.org with spam-scanned (Exim 4.71) (envelope-from ) id 1Tw5Vq-00062q-JP for qemu-devel@nongnu.org; Fri, 18 Jan 2013 01:33:20 -0500 Received: from ftcsun4.faraday-tech.com ([60.248.181.187]:56204 helo=ftcsun4.faraday.com.tw) by eggs.gnu.org with esmtp (Exim 4.71) (envelope-from ) id 1Tw5Vp-00062I-DV for qemu-devel@nongnu.org; Fri, 18 Jan 2013 01:33:14 -0500 Received: from ftcpcs100.faraday.com.tw ([192.168.31.10]) by ftcsun4.faraday.com.tw (8.11.7p1+Sun/8.11.6) with ESMTP id r0I6X6m07402 for ; Fri, 18 Jan 2013 14:33:06 +0800 (CST) Received: from FTCPCS63.faraday.com.tw (unverified [192.168.32.63]) by ftcpcs100.faraday.com.tw (Clearswift SMTPRS 5.2.9) with ESMTP id ; Fri, 18 Jan 2013 14:33:07 +0800 Received: from vmware.faraday.com.tw (192.168.65.96) by FTCPCS63.faraday.com.tw (192.168.32.65) with Microsoft SMTP Server (TLS) id 14.2.328.9; Fri, 18 Jan 2013 14:33:06 +0800 From: Dante To: Date: Fri, 18 Jan 2013 14:33:00 +0800 Message-ID: <1358490780-18757-1-git-send-email-dantesu@faraday-tech.com> X-Mailer: git-send-email 1.7.9.5 MIME-Version: 1.0 X-Originating-IP: [192.168.65.96] X-KSE-Antivirus-Interceptor-Info: scan successful X-KSE-Antivirus-Info: Clean X-detected-operating-system: by eggs.gnu.org: Genre and OS details not recognized. X-Received-From: 60.248.181.187 Cc: peter.maydell@linaro.org, paul@codesourcery.com, dantesu@faraday-tech.com Subject: [Qemu-devel] [PATCH 17/18] hw: add QEMU model for Faraday a369 keypad controller X-BeenThere: qemu-devel@nongnu.org X-Mailman-Version: 2.1.14 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Errors-To: qemu-devel-bounces+incoming=patchwork.ozlabs.org@nongnu.org Sender: qemu-devel-bounces+incoming=patchwork.ozlabs.org@nongnu.org Signed-off-by: Kuo-Jung Su --- hw/ftkbc010.c | 214 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 214 insertions(+) create mode 100644 hw/ftkbc010.c diff --git a/hw/ftkbc010.c b/hw/ftkbc010.c new file mode 100644 index 0000000..0727b5a --- /dev/null +++ b/hw/ftkbc010.c @@ -0,0 +1,214 @@ +/* + * Faraday FTKBC010 emulator for A369. + * + * Copyright (c) 2012 Faraday Technology + * + * Written by Dante Su + * + * This code is licensed under the GPL. + */ + +#include "hw.h" +#include "qemu/timer.h" +#include "sysemu/sysemu.h" +#include "sysbus.h" +#include "ui/console.h" +#include "devices.h" + +/* Key codes */ +#define KEYCODE_ESC 1 +#define KEYCODE_BACKSPACE 14 +#define KEYCODE_ENTER 28 +#define KEYCODE_SPACE 57 +#define KEYCODE_MENU 139 /* Menu (show menu) */ + +typedef struct { + SysBusDevice busdev; + MemoryRegion iomem; + qemu_irq irq; + + int x; + int y; + + /* HW registers */ + uint32_t cr; + uint32_t isr; +} ftkbc010_state; + +static inline void ftkbc010_update(void *opaque) +{ + ftkbc010_state *s = (ftkbc010_state *) opaque; + uint32_t ier = 0; + + /* keypad interrupt */ + ier |= (s->cr & (1 << 8)) ? (1 << 2) : 0; + /* tx interrupt */ + ier |= (s->cr & (1 << 3)) ? (1 << 1) : 0; + /* rx interrupt */ + ier |= (s->cr & (1 << 4)) ? (1 << 0) : 0; + + if (ier & s->isr) + qemu_irq_raise(s->irq); + else + qemu_irq_lower(s->irq); +} + +static uint64_t ftkbc010_mem_read(void *opaque, hwaddr addr, unsigned size) +{ + ftkbc010_state *s = (ftkbc010_state *) opaque; + + switch (addr) { + case 0x00: + return s->cr; + case 0x10: + return s->isr; + case 0x30: + return ~(1 << s->x); + case 0x34: + return ~(1 << s->y); + case 0x50: /* revision */ + return 0x00010403; + case 0x54: /* feature */ + return 0x00000808; + default: + break; + } + + return 0; +} + +static void ftkbc010_mem_write(void *opaque, hwaddr addr, uint64_t val, unsigned size) +{ + ftkbc010_state *s = (ftkbc010_state *) opaque; + + switch (addr) { + case 0x00: + s->cr = (uint32_t)val; + /* if ftkbc010 enabled */ + if (!(s->cr & (1 << 2))) + break; + /* if keypad interrupt cleared */ + if (s->cr & (1 << 10)) { + s->cr &= ~(1 << 10); + s->isr &= ~(1 << 2); + } + /* if rx interrupt cleared */ + if (s->cr & (1 << 7)) { + s->cr &= ~(1 << 7); + s->isr &= ~(1 << 0); + } + /* if tx interrupt cleared */ + if (s->cr & (1 << 6)) { + s->cr &= ~(1 << 6); + s->isr &= ~(1 << 1); + } + ftkbc010_update(s); + break; + default: + break; + } +} + +static const MemoryRegionOps ftkbc010_mem_ops = { + .read = ftkbc010_mem_read, + .write = ftkbc010_mem_write, + .endianness = DEVICE_LITTLE_ENDIAN, +}; + +static void ftkbc010_key_event(void *opaque, int scancode) +{ + ftkbc010_state *s = (ftkbc010_state *) opaque; + int released = 0; + + /* key release from qemu */ + if (scancode & 0x80) + released = 1; + + /* strip qemu key release bit */ + scancode &= ~0x80; + + /* keypad interrupt */ + if (!released && (s->cr & (1 << 8))) { + switch(scancode) { + case KEYCODE_ESC: + case KEYCODE_BACKSPACE: + s->x = 1; + break; + case KEYCODE_ENTER: + case KEYCODE_MENU: + case KEYCODE_SPACE: + s->x = 3; + break; + default: + s->x = 2; /* KEY_HOME */ + break; + } + s->y = 0; + s->isr |= (1 << 2); + ftkbc010_update(s); + } +} + +static int ftkbc010_post_load(void *opaque, int version_id) +{ + ftkbc010_state *s = (ftkbc010_state *) opaque; + + qemu_irq_lower(s->irq); + + return 0; +} + +static int ftkbc010_init(SysBusDevice *dev) +{ + ftkbc010_state *s = FROM_SYSBUS(ftkbc010_state, dev); + + s->cr = 0; + s->isr = 0; + s->x = 0; + s->y = 0; + + memory_region_init_io(&s->iomem, &ftkbc010_mem_ops, s, "ftkbc010", 0x1000); + sysbus_init_mmio(dev, &s->iomem); + sysbus_init_irq(dev, &s->irq); + + qemu_add_kbd_event_handler(ftkbc010_key_event, s); + + return 0; +} + +static const VMStateDescription vmstate_ftkbc010_regs = { + .name = "ftkbc010", + .version_id = 1, + .minimum_version_id = 1, + .minimum_version_id_old = 1, + .post_load = ftkbc010_post_load, + .fields = (VMStateField[]) { + VMSTATE_UINT32(cr, ftkbc010_state), + VMSTATE_UINT32(isr, ftkbc010_state), + VMSTATE_END_OF_LIST(), + } +}; + +static void ftkbc010_dev_class_init(ObjectClass *klass, void *data) +{ + DeviceClass *dc = DEVICE_CLASS(klass); + SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); + + k->init = ftkbc010_init; + dc->desc = "ftkbc010"; + dc->vmsd = &vmstate_ftkbc010_regs; +} + +static TypeInfo ftkbc010_dev_info = { + .name = "ftkbc010", + .parent = TYPE_SYS_BUS_DEVICE, + .instance_size = sizeof(ftkbc010_state), + .class_init = ftkbc010_dev_class_init, +}; + +static void ftkbc010_register_types(void) +{ + type_register_static(&ftkbc010_dev_info); +} + +type_init(ftkbc010_register_types)