LXR linux/drivers/input/touchscreen/dynapro.c

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