linux/drivers/input/keyboard/goldfish_events.c
<<
>>
Prefs
   1/*
   2 * Copyright (C) 2007 Google, Inc.
   3 * Copyright (C) 2012 Intel, Inc.
   4 *
   5 * This software is licensed under the terms of the GNU General Public
   6 * License version 2, as published by the Free Software Foundation, and
   7 * may be copied, distributed, and modified under those terms.
   8 *
   9 * This program is distributed in the hope that it will be useful,
  10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12 * GNU General Public License for more details.
  13 *
  14 */
  15
  16#include <linux/module.h>
  17#include <linux/interrupt.h>
  18#include <linux/types.h>
  19#include <linux/input.h>
  20#include <linux/kernel.h>
  21#include <linux/platform_device.h>
  22#include <linux/slab.h>
  23#include <linux/irq.h>
  24#include <linux/io.h>
  25#include <linux/acpi.h>
  26
  27enum {
  28        REG_READ        = 0x00,
  29        REG_SET_PAGE    = 0x00,
  30        REG_LEN         = 0x04,
  31        REG_DATA        = 0x08,
  32
  33        PAGE_NAME       = 0x00000,
  34        PAGE_EVBITS     = 0x10000,
  35        PAGE_ABSDATA    = 0x20000 | EV_ABS,
  36};
  37
  38struct event_dev {
  39        struct input_dev *input;
  40        int irq;
  41        void __iomem *addr;
  42        char name[0];
  43};
  44
  45static irqreturn_t events_interrupt(int irq, void *dev_id)
  46{
  47        struct event_dev *edev = dev_id;
  48        unsigned int type, code, value;
  49
  50        type = __raw_readl(edev->addr + REG_READ);
  51        code = __raw_readl(edev->addr + REG_READ);
  52        value = __raw_readl(edev->addr + REG_READ);
  53
  54        input_event(edev->input, type, code, value);
  55        input_sync(edev->input);
  56        return IRQ_HANDLED;
  57}
  58
  59static void events_import_bits(struct event_dev *edev,
  60                        unsigned long bits[], unsigned int type, size_t count)
  61{
  62        void __iomem *addr = edev->addr;
  63        int i, j;
  64        size_t size;
  65        uint8_t val;
  66
  67        __raw_writel(PAGE_EVBITS | type, addr + REG_SET_PAGE);
  68
  69        size = __raw_readl(addr + REG_LEN) * 8;
  70        if (size < count)
  71                count = size;
  72
  73        addr += REG_DATA;
  74        for (i = 0; i < count; i += 8) {
  75                val = __raw_readb(addr++);
  76                for (j = 0; j < 8; j++)
  77                        if (val & 1 << j)
  78                                set_bit(i + j, bits);
  79        }
  80}
  81
  82static void events_import_abs_params(struct event_dev *edev)
  83{
  84        struct input_dev *input_dev = edev->input;
  85        void __iomem *addr = edev->addr;
  86        u32 val[4];
  87        int count;
  88        int i, j;
  89
  90        __raw_writel(PAGE_ABSDATA, addr + REG_SET_PAGE);
  91
  92        count = __raw_readl(addr + REG_LEN) / sizeof(val);
  93        if (count > ABS_MAX)
  94                count = ABS_MAX;
  95
  96        for (i = 0; i < count; i++) {
  97                if (!test_bit(i, input_dev->absbit))
  98                        continue;
  99
 100                for (j = 0; j < ARRAY_SIZE(val); j++) {
 101                        int offset = (i * ARRAY_SIZE(val) + j) * sizeof(u32);
 102
 103                        val[j] = __raw_readl(edev->addr + REG_DATA + offset);
 104                }
 105
 106                input_set_abs_params(input_dev, i,
 107                                     val[0], val[1], val[2], val[3]);
 108        }
 109}
 110
 111static int events_probe(struct platform_device *pdev)
 112{
 113        struct input_dev *input_dev;
 114        struct event_dev *edev;
 115        struct resource *res;
 116        unsigned int keymapnamelen;
 117        void __iomem *addr;
 118        int irq;
 119        int i;
 120        int error;
 121
 122        irq = platform_get_irq(pdev, 0);
 123        if (irq < 0)
 124                return -EINVAL;
 125
 126        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 127        if (!res)
 128                return -EINVAL;
 129
 130        addr = devm_ioremap(&pdev->dev, res->start, 4096);
 131        if (!addr)
 132                return -ENOMEM;
 133
 134        __raw_writel(PAGE_NAME, addr + REG_SET_PAGE);
 135        keymapnamelen = __raw_readl(addr + REG_LEN);
 136
 137        edev = devm_kzalloc(&pdev->dev,
 138                            sizeof(struct event_dev) + keymapnamelen + 1,
 139                            GFP_KERNEL);
 140        if (!edev)
 141                return -ENOMEM;
 142
 143        input_dev = devm_input_allocate_device(&pdev->dev);
 144        if (!input_dev)
 145                return -ENOMEM;
 146
 147        edev->input = input_dev;
 148        edev->addr = addr;
 149        edev->irq = irq;
 150
 151        for (i = 0; i < keymapnamelen; i++)
 152                edev->name[i] = __raw_readb(edev->addr + REG_DATA + i);
 153
 154        pr_debug("%s: keymap=%s\n", __func__, edev->name);
 155
 156        input_dev->name = edev->name;
 157        input_dev->id.bustype = BUS_HOST;
 158
 159        events_import_bits(edev, input_dev->evbit, EV_SYN, EV_MAX);
 160        events_import_bits(edev, input_dev->keybit, EV_KEY, KEY_MAX);
 161        events_import_bits(edev, input_dev->relbit, EV_REL, REL_MAX);
 162        events_import_bits(edev, input_dev->absbit, EV_ABS, ABS_MAX);
 163        events_import_bits(edev, input_dev->mscbit, EV_MSC, MSC_MAX);
 164        events_import_bits(edev, input_dev->ledbit, EV_LED, LED_MAX);
 165        events_import_bits(edev, input_dev->sndbit, EV_SND, SND_MAX);
 166        events_import_bits(edev, input_dev->ffbit, EV_FF, FF_MAX);
 167        events_import_bits(edev, input_dev->swbit, EV_SW, SW_MAX);
 168
 169        events_import_abs_params(edev);
 170
 171        error = devm_request_irq(&pdev->dev, edev->irq, events_interrupt, 0,
 172                                 "goldfish-events-keypad", edev);
 173        if (error)
 174                return error;
 175
 176        error = input_register_device(input_dev);
 177        if (error)
 178                return error;
 179
 180        return 0;
 181}
 182
 183static const struct of_device_id goldfish_events_of_match[] = {
 184        { .compatible = "google,goldfish-events-keypad", },
 185        {},
 186};
 187MODULE_DEVICE_TABLE(of, goldfish_events_of_match);
 188
 189#ifdef CONFIG_ACPI
 190static const struct acpi_device_id goldfish_events_acpi_match[] = {
 191        { "GFSH0002", 0 },
 192        { },
 193};
 194MODULE_DEVICE_TABLE(acpi, goldfish_events_acpi_match);
 195#endif
 196
 197static struct platform_driver events_driver = {
 198        .probe  = events_probe,
 199        .driver = {
 200                .name   = "goldfish_events",
 201                .of_match_table = goldfish_events_of_match,
 202                .acpi_match_table = ACPI_PTR(goldfish_events_acpi_match),
 203        },
 204};
 205
 206module_platform_driver(events_driver);
 207
 208MODULE_AUTHOR("Brian Swetland");
 209MODULE_DESCRIPTION("Goldfish Event Device");
 210MODULE_LICENSE("GPL");
 211