Root/target/linux/goldfish/patches-2.6.30/0123--ARM-goldfish-events-Add-event-driver-for-goldfis.patch

1From 226fd290dc2d052e5cd437cc8464e1424e7ebf2c Mon Sep 17 00:00:00 2001
2From: Brian Swetland <swetland@google.com>
3Date: Sun, 13 Aug 2006 21:50:14 +0700
4Subject: [PATCH 123/134] [ARM] goldfish: events: Add event driver for goldfish
5
6this device is a direct pipe from "hardware" to the input
7event subsystem, allowing us to avoid having to route
8"keypad" style events through an AT keyboard driver (gross!)
9
10Signed-off-by: Mike A. Chan <mikechan@google.com>
11---
12 drivers/input/keyboard/Kconfig | 5 +
13 drivers/input/keyboard/Makefile | 1 +
14 drivers/input/keyboard/goldfish_events.c | 190 ++++++++++++++++++++++++++++++
15 3 files changed, 196 insertions(+), 0 deletions(-)
16 create mode 100644 drivers/input/keyboard/goldfish_events.c
17
18--- a/drivers/input/keyboard/Kconfig
19+++ b/drivers/input/keyboard/Kconfig
20@@ -304,6 +304,11 @@ config KEYBOARD_GPIO
21       To compile this driver as a module, choose M here: the
22       module will be called gpio-keys.
23 
24+config KEYBOARD_GOLDFISH_EVENTS
25+ tristate "Generic Input Event device for Goldfish"
26+ help
27+ no help
28+
29 config KEYBOARD_MAPLE
30     tristate "Maple bus keyboard"
31     depends on SH_DREAMCAST && MAPLE
32--- a/drivers/input/keyboard/Makefile
33+++ b/drivers/input/keyboard/Makefile
34@@ -23,6 +23,7 @@ obj-$(CONFIG_KEYBOARD_PXA27x) += pxa27x
35 obj-$(CONFIG_KEYBOARD_PXA930_ROTARY) += pxa930_rotary.o
36 obj-$(CONFIG_KEYBOARD_AAED2000) += aaed2000_kbd.o
37 obj-$(CONFIG_KEYBOARD_GPIO) += gpio_keys.o
38+obj-$(CONFIG_KEYBOARD_GOLDFISH_EVENTS) += goldfish_events.o
39 obj-$(CONFIG_KEYBOARD_HP6XX) += jornada680_kbd.o
40 obj-$(CONFIG_KEYBOARD_HP7XX) += jornada720_kbd.o
41 obj-$(CONFIG_KEYBOARD_MAPLE) += maple_keyb.o
42--- /dev/null
43+++ b/drivers/input/keyboard/goldfish_events.c
44@@ -0,0 +1,190 @@
45+/* drivers/input/keyboard/goldfish-events.c
46+**
47+** Copyright (C) 2007 Google, Inc.
48+**
49+** This software is licensed under the terms of the GNU General Public
50+** License version 2, as published by the Free Software Foundation, and
51+** may be copied, distributed, and modified under those terms.
52+**
53+** This program is distributed in the hope that it will be useful,
54+** but WITHOUT ANY WARRANTY; without even the implied warranty of
55+** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
56+** GNU General Public License for more details.
57+**
58+*/
59+
60+#include <linux/module.h>
61+#include <linux/init.h>
62+#include <linux/interrupt.h>
63+#include <linux/types.h>
64+#include <linux/input.h>
65+#include <linux/kernel.h>
66+#include <linux/platform_device.h>
67+
68+#include <mach/hardware.h>
69+#include <asm/irq.h>
70+#include <asm/io.h>
71+
72+enum {
73+ REG_READ = 0x00,
74+ REG_SET_PAGE = 0x00,
75+ REG_LEN = 0x04,
76+ REG_DATA = 0x08,
77+
78+ PAGE_NAME = 0x00000,
79+ PAGE_EVBITS = 0x10000,
80+ PAGE_ABSDATA = 0x20000 | EV_ABS,
81+};
82+
83+struct event_dev {
84+ struct input_dev *input;
85+ int irq;
86+ unsigned addr;
87+ char name[0];
88+};
89+
90+static irqreturn_t events_interrupt(int irq, void *dev_id)
91+{
92+ struct event_dev *edev = dev_id;
93+ unsigned type, code, value;
94+
95+ type = __raw_readl(edev->addr + REG_READ);
96+ code = __raw_readl(edev->addr + REG_READ);
97+ value = __raw_readl(edev->addr + REG_READ);
98+
99+ input_event(edev->input, type, code, value);
100+ return IRQ_HANDLED;
101+}
102+
103+static void events_import_bits(struct event_dev *edev, unsigned long bits[], unsigned type, size_t count)
104+{
105+ int i, j;
106+ size_t size;
107+ uint8_t val;
108+ unsigned addr = edev->addr;
109+ __raw_writel(PAGE_EVBITS | type, addr + REG_SET_PAGE);
110+ size = __raw_readl(addr + REG_LEN) * 8;
111+ if (size < count)
112+ count = size;
113+ addr = addr + REG_DATA;
114+ for (i = 0; i < count; i += 8) {
115+ val = __raw_readb(addr++);
116+ for (j = 0; j < 8; j++)
117+ if(val & 1 << j)
118+ set_bit(i + j, bits);
119+ }
120+}
121+
122+static int events_probe(struct platform_device *pdev)
123+{
124+ struct input_dev *input_dev;
125+ struct event_dev *edev = NULL;
126+ struct resource *res;
127+ unsigned keymapnamelen;
128+ int i;
129+ int count;
130+ int irq;
131+ unsigned addr;
132+ int ret;
133+
134+ printk("*** events probe ***\n");
135+
136+ input_dev = input_allocate_device();
137+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
138+ if(!input_dev || !res) goto fail;
139+
140+ addr = (unsigned) ioremap(res->start, 4096);
141+ irq = platform_get_irq(pdev, 0);
142+
143+ printk("events_probe() addr=0x%08x irq=%d\n", addr, irq);
144+
145+ if(!addr) goto fail;
146+ if(irq < 0) goto fail;
147+
148+ __raw_writel(PAGE_NAME, addr + REG_SET_PAGE);
149+ keymapnamelen = __raw_readl(addr + REG_LEN);
150+
151+ edev = kzalloc(sizeof(struct event_dev) + keymapnamelen + 1, GFP_KERNEL);
152+ if (!edev) goto fail;
153+
154+ edev->input = input_dev;
155+ edev->addr = addr;
156+ edev->irq = irq;
157+
158+ for (i = 0; i < keymapnamelen; i++) {
159+ edev->name[i] = __raw_readb(edev->addr + REG_DATA + i);
160+ }
161+ printk("events_probe() keymap=%s\n", edev->name);
162+
163+ events_import_bits(edev, input_dev->evbit, EV_SYN, EV_MAX);
164+ events_import_bits(edev, input_dev->keybit, EV_KEY, KEY_MAX);
165+ events_import_bits(edev, input_dev->relbit, EV_REL, REL_MAX);
166+ events_import_bits(edev, input_dev->absbit, EV_ABS, ABS_MAX);
167+ events_import_bits(edev, input_dev->mscbit, EV_MSC, MSC_MAX);
168+ events_import_bits(edev, input_dev->ledbit, EV_LED, LED_MAX);
169+ events_import_bits(edev, input_dev->sndbit, EV_SND, SND_MAX);
170+ events_import_bits(edev, input_dev->ffbit, EV_FF, FF_MAX);
171+ events_import_bits(edev, input_dev->swbit, EV_SW, SW_MAX);
172+
173+ __raw_writel(PAGE_ABSDATA, addr + REG_SET_PAGE);
174+ count = __raw_readl(addr + REG_LEN) / (4 * 4);
175+ if (count > ABS_MAX)
176+ count = ABS_MAX;
177+ for(i = 0; i < count; i++) {
178+ int val[4];
179+ int j;
180+ if (!test_bit(i, input_dev->absbit))
181+ continue;
182+ for(j = 0; j < ARRAY_SIZE(val); j++)
183+ val[j] = __raw_readl(edev->addr + REG_DATA + (i * ARRAY_SIZE(val) + j) * 4);
184+ input_set_abs_params(input_dev, i, val[0], val[1], val[2], val[3]);
185+ }
186+
187+ platform_set_drvdata(pdev, edev);
188+
189+ input_dev->name = edev->name;
190+ input_set_drvdata(input_dev, edev);
191+
192+ ret = input_register_device(input_dev);
193+ if (ret)
194+ goto fail;
195+
196+ if(request_irq(edev->irq, events_interrupt, 0,
197+ "goldfish-events-keypad", edev) < 0) {
198+ input_unregister_device(input_dev);
199+ kfree(edev);
200+ return -EINVAL;
201+ }
202+
203+ return 0;
204+
205+fail:
206+ kfree(edev);
207+ input_free_device(input_dev);
208+
209+ return -EINVAL;
210+}
211+
212+static struct platform_driver events_driver = {
213+ .probe = events_probe,
214+ .driver = {
215+ .name = "goldfish_events",
216+ },
217+};
218+
219+static int __devinit events_init(void)
220+{
221+ return platform_driver_register(&events_driver);
222+}
223+
224+
225+static void __exit events_exit(void)
226+{
227+}
228+
229+module_init(events_init);
230+module_exit(events_exit);
231+
232+MODULE_AUTHOR("Brian Swetland");
233+MODULE_DESCRIPTION("Goldfish Event Device");
234+MODULE_LICENSE("GPL");
235

Archive Download this file



interactive