mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-19 22:36:49 +07:00
c942fddf87
Based on 3 normalized pattern(s): this program is free software you can redistribute it and or modify it under the terms of the gnu general public license as published by the free software foundation either version 2 of the license or at your option any later version this program is distributed in the hope that it will be useful but without any warranty without even the implied warranty of merchantability or fitness for a particular purpose see the gnu general public license for more details this program is free software you can redistribute it and or modify it under the terms of the gnu general public license as published by the free software foundation either version 2 of the license or at your option any later version [author] [kishon] [vijay] [abraham] [i] [kishon]@[ti] [com] this program is distributed in the hope that it will be useful but without any warranty without even the implied warranty of merchantability or fitness for a particular purpose see the gnu general public license for more details this program is free software you can redistribute it and or modify it under the terms of the gnu general public license as published by the free software foundation either version 2 of the license or at your option any later version [author] [graeme] [gregory] [gg]@[slimlogic] [co] [uk] [author] [kishon] [vijay] [abraham] [i] [kishon]@[ti] [com] [based] [on] [twl6030]_[usb] [c] [author] [hema] [hk] [hemahk]@[ti] [com] this program is distributed in the hope that it will be useful but without any warranty without even the implied warranty of merchantability or fitness for a particular purpose see the gnu general public license for more details extracted by the scancode license scanner the SPDX license identifier GPL-2.0-or-later has been chosen to replace the boilerplate/reference in 1105 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Allison Randal <allison@lohutok.net> Reviewed-by: Richard Fontana <rfontana@redhat.com> Reviewed-by: Kate Stewart <kstewart@linuxfoundation.org> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190527070033.202006027@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
260 lines
5.7 KiB
C
260 lines
5.7 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* Copyright (C) 2016, Jelle van der Waa <jelle@vdwaa.nl>
|
|
*/
|
|
|
|
#include <linux/delay.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/input.h>
|
|
#include <linux/input/mt.h>
|
|
#include <linux/input/touchscreen.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/module.h>
|
|
#include <linux/regulator/consumer.h>
|
|
#include <asm/unaligned.h>
|
|
|
|
#define ZET6223_MAX_FINGERS 16
|
|
#define ZET6223_MAX_PKT_SIZE (3 + 4 * ZET6223_MAX_FINGERS)
|
|
|
|
#define ZET6223_CMD_INFO 0xB2
|
|
#define ZET6223_CMD_INFO_LENGTH 17
|
|
#define ZET6223_VALID_PACKET 0x3c
|
|
|
|
#define ZET6223_POWER_ON_DELAY_MSEC 30
|
|
|
|
struct zet6223_ts {
|
|
struct i2c_client *client;
|
|
struct input_dev *input;
|
|
struct regulator *vcc;
|
|
struct regulator *vio;
|
|
struct touchscreen_properties prop;
|
|
struct regulator_bulk_data supplies[2];
|
|
u16 max_x;
|
|
u16 max_y;
|
|
u8 fingernum;
|
|
};
|
|
|
|
static int zet6223_start(struct input_dev *dev)
|
|
{
|
|
struct zet6223_ts *ts = input_get_drvdata(dev);
|
|
|
|
enable_irq(ts->client->irq);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void zet6223_stop(struct input_dev *dev)
|
|
{
|
|
struct zet6223_ts *ts = input_get_drvdata(dev);
|
|
|
|
disable_irq(ts->client->irq);
|
|
}
|
|
|
|
static irqreturn_t zet6223_irq(int irq, void *dev_id)
|
|
{
|
|
struct zet6223_ts *ts = dev_id;
|
|
u16 finger_bits;
|
|
|
|
/*
|
|
* First 3 bytes are an identifier, two bytes of finger data.
|
|
* X, Y data per finger is 4 bytes.
|
|
*/
|
|
u8 bufsize = 3 + 4 * ts->fingernum;
|
|
u8 buf[ZET6223_MAX_PKT_SIZE];
|
|
int i;
|
|
int ret;
|
|
int error;
|
|
|
|
ret = i2c_master_recv(ts->client, buf, bufsize);
|
|
if (ret != bufsize) {
|
|
error = ret < 0 ? ret : -EIO;
|
|
dev_err_ratelimited(&ts->client->dev,
|
|
"Error reading input data: %d\n", error);
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
if (buf[0] != ZET6223_VALID_PACKET)
|
|
return IRQ_HANDLED;
|
|
|
|
finger_bits = get_unaligned_be16(buf + 1);
|
|
for (i = 0; i < ts->fingernum; i++) {
|
|
if (!(finger_bits & BIT(15 - i)))
|
|
continue;
|
|
|
|
input_mt_slot(ts->input, i);
|
|
input_mt_report_slot_state(ts->input, MT_TOOL_FINGER, true);
|
|
input_event(ts->input, EV_ABS, ABS_MT_POSITION_X,
|
|
((buf[i + 3] >> 4) << 8) + buf[i + 4]);
|
|
input_event(ts->input, EV_ABS, ABS_MT_POSITION_Y,
|
|
((buf[i + 3] & 0xF) << 8) + buf[i + 5]);
|
|
}
|
|
|
|
input_mt_sync_frame(ts->input);
|
|
input_sync(ts->input);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static void zet6223_power_off(void *_ts)
|
|
{
|
|
struct zet6223_ts *ts = _ts;
|
|
|
|
regulator_bulk_disable(ARRAY_SIZE(ts->supplies), ts->supplies);
|
|
}
|
|
|
|
static int zet6223_power_on(struct zet6223_ts *ts)
|
|
{
|
|
struct device *dev = &ts->client->dev;
|
|
int error;
|
|
|
|
ts->supplies[0].supply = "vio";
|
|
ts->supplies[1].supply = "vcc";
|
|
|
|
error = devm_regulator_bulk_get(dev, ARRAY_SIZE(ts->supplies),
|
|
ts->supplies);
|
|
if (error)
|
|
return error;
|
|
|
|
error = regulator_bulk_enable(ARRAY_SIZE(ts->supplies), ts->supplies);
|
|
if (error)
|
|
return error;
|
|
|
|
msleep(ZET6223_POWER_ON_DELAY_MSEC);
|
|
|
|
error = devm_add_action_or_reset(dev, zet6223_power_off, ts);
|
|
if (error) {
|
|
dev_err(dev, "failed to install poweroff action: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int zet6223_query_device(struct zet6223_ts *ts)
|
|
{
|
|
u8 buf[ZET6223_CMD_INFO_LENGTH];
|
|
u8 cmd = ZET6223_CMD_INFO;
|
|
int ret;
|
|
int error;
|
|
|
|
ret = i2c_master_send(ts->client, &cmd, sizeof(cmd));
|
|
if (ret != sizeof(cmd)) {
|
|
error = ret < 0 ? ret : -EIO;
|
|
dev_err(&ts->client->dev,
|
|
"touchpanel info cmd failed: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
ret = i2c_master_recv(ts->client, buf, sizeof(buf));
|
|
if (ret != sizeof(buf)) {
|
|
error = ret < 0 ? ret : -EIO;
|
|
dev_err(&ts->client->dev,
|
|
"failed to retrieve touchpanel info: %d\n", error);
|
|
return error;
|
|
}
|
|
|
|
ts->fingernum = buf[15] & 0x7F;
|
|
if (ts->fingernum > ZET6223_MAX_FINGERS) {
|
|
dev_warn(&ts->client->dev,
|
|
"touchpanel reports %d fingers, limiting to %d\n",
|
|
ts->fingernum, ZET6223_MAX_FINGERS);
|
|
ts->fingernum = ZET6223_MAX_FINGERS;
|
|
}
|
|
|
|
ts->max_x = get_unaligned_le16(&buf[8]);
|
|
ts->max_y = get_unaligned_le16(&buf[10]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int zet6223_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
struct device *dev = &client->dev;
|
|
struct zet6223_ts *ts;
|
|
struct input_dev *input;
|
|
int error;
|
|
|
|
if (!client->irq) {
|
|
dev_err(dev, "no irq specified\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ts = devm_kzalloc(dev, sizeof(*ts), GFP_KERNEL);
|
|
if (!ts)
|
|
return -ENOMEM;
|
|
|
|
ts->client = client;
|
|
|
|
error = zet6223_power_on(ts);
|
|
if (error)
|
|
return error;
|
|
|
|
error = zet6223_query_device(ts);
|
|
if (error)
|
|
return error;
|
|
|
|
ts->input = input = devm_input_allocate_device(dev);
|
|
if (!input)
|
|
return -ENOMEM;
|
|
|
|
input_set_drvdata(input, ts);
|
|
|
|
input->name = client->name;
|
|
input->id.bustype = BUS_I2C;
|
|
input->open = zet6223_start;
|
|
input->close = zet6223_stop;
|
|
|
|
input_set_abs_params(input, ABS_MT_POSITION_X, 0, ts->max_x, 0, 0);
|
|
input_set_abs_params(input, ABS_MT_POSITION_Y, 0, ts->max_y, 0, 0);
|
|
|
|
touchscreen_parse_properties(input, true, &ts->prop);
|
|
|
|
error = input_mt_init_slots(input, ts->fingernum,
|
|
INPUT_MT_DIRECT | INPUT_MT_DROP_UNUSED);
|
|
if (error)
|
|
return error;
|
|
|
|
error = devm_request_threaded_irq(dev, client->irq, NULL, zet6223_irq,
|
|
IRQF_ONESHOT, client->name, ts);
|
|
if (error) {
|
|
dev_err(dev, "failed to request irq %d: %d\n",
|
|
client->irq, error);
|
|
return error;
|
|
}
|
|
|
|
zet6223_stop(input);
|
|
|
|
error = input_register_device(input);
|
|
if (error)
|
|
return error;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id zet6223_of_match[] = {
|
|
{ .compatible = "zeitec,zet6223" },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, zet6223_of_match);
|
|
|
|
static const struct i2c_device_id zet6223_id[] = {
|
|
{ "zet6223", 0},
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, zet6223_id);
|
|
|
|
static struct i2c_driver zet6223_driver = {
|
|
.driver = {
|
|
.name = "zet6223",
|
|
.of_match_table = zet6223_of_match,
|
|
},
|
|
.probe = zet6223_probe,
|
|
.id_table = zet6223_id
|
|
};
|
|
module_i2c_driver(zet6223_driver);
|
|
|
|
MODULE_AUTHOR("Jelle van der Waa <jelle@vdwaa.nl>");
|
|
MODULE_DESCRIPTION("ZEITEC zet622x I2C touchscreen driver");
|
|
MODULE_LICENSE("GPL");
|