^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) * Dynapro serial touchscreen driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (c) 2009 Tias Guns
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Based on the inexio driver (c) Vojtech Pavlik and Dan Streetman and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Richard Lemon
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * 2009/09/19 Tias Guns <tias@ulyssis.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) * Copied inexio.c and edited for Dynapro protocol (from retired Xorg module)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/input.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/serio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #define DRIVER_DESC "Dynapro serial touchscreen driver"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) MODULE_AUTHOR("Tias Guns <tias@ulyssis.org>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) MODULE_DESCRIPTION(DRIVER_DESC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) * Definitions & global arrays.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define DYNAPRO_FORMAT_TOUCH_BIT 0x40
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define DYNAPRO_FORMAT_LENGTH 3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define DYNAPRO_RESPONSE_BEGIN_BYTE 0x80
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define DYNAPRO_MIN_XC 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define DYNAPRO_MAX_XC 0x3ff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define DYNAPRO_MIN_YC 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define DYNAPRO_MAX_YC 0x3ff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define DYNAPRO_GET_XC(data) (data[1] | ((data[0] & 0x38) << 4))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define DYNAPRO_GET_YC(data) (data[2] | ((data[0] & 0x07) << 7))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define DYNAPRO_GET_TOUCHED(data) (DYNAPRO_FORMAT_TOUCH_BIT & data[0])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) * Per-touchscreen data.
^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) struct dynapro {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) struct input_dev *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) struct serio *serio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) int idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) unsigned char data[DYNAPRO_FORMAT_LENGTH];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) char phys[32];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) static void dynapro_process_data(struct dynapro *pdynapro)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) struct input_dev *dev = pdynapro->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) if (DYNAPRO_FORMAT_LENGTH == ++pdynapro->idx) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) input_report_abs(dev, ABS_X, DYNAPRO_GET_XC(pdynapro->data));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) input_report_abs(dev, ABS_Y, DYNAPRO_GET_YC(pdynapro->data));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) input_report_key(dev, BTN_TOUCH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) DYNAPRO_GET_TOUCHED(pdynapro->data));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) input_sync(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) pdynapro->idx = 0;
^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 irqreturn_t dynapro_interrupt(struct serio *serio,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) unsigned char data, unsigned int flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) struct dynapro *pdynapro = serio_get_drvdata(serio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) pdynapro->data[pdynapro->idx] = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) if (DYNAPRO_RESPONSE_BEGIN_BYTE & pdynapro->data[0])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) dynapro_process_data(pdynapro);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) dev_dbg(&serio->dev, "unknown/unsynchronized data: %x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) pdynapro->data[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) static void dynapro_disconnect(struct serio *serio)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) struct dynapro *pdynapro = serio_get_drvdata(serio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) input_get_device(pdynapro->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) input_unregister_device(pdynapro->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) serio_close(serio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) serio_set_drvdata(serio, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) input_put_device(pdynapro->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) kfree(pdynapro);
^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) * dynapro_connect() is the routine that is called when someone adds a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) * new serio device that supports dynapro protocol and registers it as
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) * an input device. This is usually accomplished using inputattach.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) static int dynapro_connect(struct serio *serio, struct serio_driver *drv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) struct dynapro *pdynapro;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) struct input_dev *input_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) pdynapro = kzalloc(sizeof(struct dynapro), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) input_dev = input_allocate_device();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) if (!pdynapro || !input_dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) err = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) goto fail1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) pdynapro->serio = serio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) pdynapro->dev = input_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) snprintf(pdynapro->phys, sizeof(pdynapro->phys),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) "%s/input0", serio->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) input_dev->name = "Dynapro Serial TouchScreen";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) input_dev->phys = pdynapro->phys;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) input_dev->id.bustype = BUS_RS232;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) input_dev->id.vendor = SERIO_DYNAPRO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) input_dev->id.product = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) input_dev->id.version = 0x0001;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) input_dev->dev.parent = &serio->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) input_set_abs_params(pdynapro->dev, ABS_X,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) DYNAPRO_MIN_XC, DYNAPRO_MAX_XC, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) input_set_abs_params(pdynapro->dev, ABS_Y,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) DYNAPRO_MIN_YC, DYNAPRO_MAX_YC, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) serio_set_drvdata(serio, pdynapro);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) err = serio_open(serio, drv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) goto fail2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) err = input_register_device(pdynapro->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) goto fail3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) fail3: serio_close(serio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) fail2: serio_set_drvdata(serio, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) fail1: input_free_device(input_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) kfree(pdynapro);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) * The serio driver structure.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) static const struct serio_device_id dynapro_serio_ids[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) .type = SERIO_RS232,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) .proto = SERIO_DYNAPRO,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) .id = SERIO_ANY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) .extra = SERIO_ANY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) { 0 }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) MODULE_DEVICE_TABLE(serio, dynapro_serio_ids);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) static struct serio_driver dynapro_drv = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) .name = "dynapro",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) .description = DRIVER_DESC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) .id_table = dynapro_serio_ids,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) .interrupt = dynapro_interrupt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) .connect = dynapro_connect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) .disconnect = dynapro_disconnect,
^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_serio_driver(dynapro_drv);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags