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