Commit 102feb1d authored by Lucas Stach's avatar Lucas Stach Committed by Dmitry Torokhov
Browse files

Input: exc3000 - factor out vendor data request 



Factor out the vendor data i2c request handling to make it reusable
for other functions. Also don't cache the model and firmware version
string in the device private data as we never use the cached version,
but always read from the device.

Signed-off-by: default avatarLucas Stach <l.stach@pengutronix.de>
Link: https://lore.kernel.org/r/20210125182527.1225245-3-l.stach@pengutronix.de


Signed-off-by: default avatarDmitry Torokhov <dmitry.torokhov@gmail.com>
parent a63d0120

drivers/input/touchscreen/exc3000.c

+54 −68
Original line number Diff line number Diff line
@@ -25,6 +25,7 @@ 
#define EXC3000_NUM_SLOTS		10

#define EXC3000_SLOTS_PER_FRAME		5

#define EXC3000_LEN_FRAME		66

#define EXC3000_LEN_VENDOR_REQUEST	68

#define EXC3000_LEN_POINT		10



#define EXC3000_LEN_MODEL_NAME		16
@@ -77,9 +78,6 @@ struct exc3000_data { 
	u8 buf[2 * EXC3000_LEN_FRAME];

	struct completion wait_event;

	struct mutex query_lock;

	int query_result;

	char model[EXC3000_LEN_MODEL_NAME];

	char fw_version[EXC3000_LEN_FW_VERSION];

};



static void exc3000_report_slots(struct input_dev *input,
@@ -186,23 +184,6 @@ static int exc3000_handle_mt_event(struct exc3000_data *data) 
	return ret;

}



static int exc3000_query_interrupt(struct exc3000_data *data)

{

	u8 *buf = data->buf;



	if (buf[0] != 'B')

		return -EPROTO;



	if (buf[4] == 'E')

		strlcpy(data->model, buf + 5, sizeof(data->model));

	else if (buf[4] == 'D')

		strlcpy(data->fw_version, buf + 5, sizeof(data->fw_version));

	else

		return -EPROTO;



	return 0;

}



static irqreturn_t exc3000_interrupt(int irq, void *dev_id)

{

	struct exc3000_data *data = dev_id;
@@ -218,7 +199,6 @@ static irqreturn_t exc3000_interrupt(int irq, void *dev_id) 


	switch (buf[2]) {

	case EXC3000_VENDOR_EVENT:

		data->query_result = exc3000_query_interrupt(data);

		complete(&data->wait_event);

		break;
@@ -235,73 +215,75 @@ static irqreturn_t exc3000_interrupt(int irq, void *dev_id) 
	return IRQ_HANDLED;

}



static ssize_t fw_version_show(struct device *dev,

			       struct device_attribute *attr, char *buf)

static int exc3000_vendor_data_request(struct exc3000_data *data, u8 *request,

				       u8 request_len, u8 *response, int timeout)

{

	struct i2c_client *client = to_i2c_client(dev);

	struct exc3000_data *data = i2c_get_clientdata(client);

	static const u8 request[68] = {

		0x67, 0x00, 0x42, 0x00, 0x03, 0x01, 'D', 0x00

	};

	int error;

	u8 buf[EXC3000_LEN_VENDOR_REQUEST] = { 0x67, 0x00, 0x42, 0x00, 0x03 };

	int ret;



	mutex_lock(&data->query_lock);



	data->query_result = -ETIMEDOUT;

	reinit_completion(&data->wait_event);



	error = i2c_master_send(client, request, sizeof(request));

	if (error < 0) {

		mutex_unlock(&data->query_lock);

		return error;

	}



	wait_for_completion_interruptible_timeout(&data->wait_event, 1 * HZ);

	mutex_unlock(&data->query_lock);



	if (data->query_result < 0)

		return data->query_result;

	buf[5] = request_len;

	memcpy(&buf[6], request, request_len);



	return sprintf(buf, "%s\n", data->fw_version);

	ret = i2c_master_send(data->client, buf, EXC3000_LEN_VENDOR_REQUEST);

	if (ret < 0)

		goto out_unlock;



	if (response) {

		ret = wait_for_completion_timeout(&data->wait_event,

						  timeout * HZ);

		if (ret <= 0) {

			ret = -ETIMEDOUT;

			goto out_unlock;

		}

static DEVICE_ATTR_RO(fw_version);



static ssize_t exc3000_get_model(struct exc3000_data *data)

{

	static const u8 request[68] = {

		0x67, 0x00, 0x42, 0x00, 0x03, 0x01, 'E', 0x00

	};

	struct i2c_client *client = data->client;

	int error;

		if (data->buf[3] >= EXC3000_LEN_FRAME) {

			ret = -ENOSPC;

			goto out_unlock;

		}



	mutex_lock(&data->query_lock);

	data->query_result = -ETIMEDOUT;

	reinit_completion(&data->wait_event);

		memcpy(response, &data->buf[4], data->buf[3]);

		ret = data->buf[3];

	}



	error = i2c_master_send(client, request, sizeof(request));

	if (error < 0) {

out_unlock:

	mutex_unlock(&data->query_lock);

		return error;



	return ret;

}



	wait_for_completion_interruptible_timeout(&data->wait_event, 1 * HZ);

	mutex_unlock(&data->query_lock);

static ssize_t fw_version_show(struct device *dev,

			       struct device_attribute *attr, char *buf)

{

	struct i2c_client *client = to_i2c_client(dev);

	struct exc3000_data *data = i2c_get_clientdata(client);

	u8 response[EXC3000_LEN_FRAME];

	int ret;



	ret = exc3000_vendor_data_request(data, (u8[]){'D'}, 1, response, 1);

	if (ret < 0)

		return ret;



	return data->query_result;

	return sprintf(buf, "%s\n", &response[1]);

}

static DEVICE_ATTR_RO(fw_version);



static ssize_t model_show(struct device *dev,

			  struct device_attribute *attr, char *buf)

{

	struct i2c_client *client = to_i2c_client(dev);

	struct exc3000_data *data = i2c_get_clientdata(client);

	int error;

	u8 response[EXC3000_LEN_FRAME];

	int ret;



	error = exc3000_get_model(data);

	if (error < 0)

		return error;

	ret = exc3000_vendor_data_request(data, (u8[]){'E'}, 1, response, 1);

	if (ret < 0)

		return ret;



	return sprintf(buf, "%s\n", data->model);

	return sprintf(buf, "%s\n", &response[1]);

}

static DEVICE_ATTR_RO(model);
@@ -387,9 +369,15 @@ static int exc3000_probe(struct i2c_client *client) 
	 * or two touch events anyways).

	 */

	for (retry = 0; retry < 3; retry++) {

		error = exc3000_get_model(data);

		if (!error)

		u8 response[EXC3000_LEN_FRAME];



		error = exc3000_vendor_data_request(data, (u8[]){'E'}, 1,

						    response, 1);

		if (error > 0) {

			dev_dbg(&client->dev, "TS Model: %s", &response[1]);

			error = 0;

			break;

		}

		dev_warn(&client->dev, "Retry %d get EETI EXC3000 model: %d\n",

			 retry + 1, error);

	}
@@ -397,8 +385,6 @@ static int exc3000_probe(struct i2c_client *client) 
	if (error)

		return error;



	dev_dbg(&client->dev, "TS Model: %s", data->model);



	i2c_set_clientdata(client, data);



	error = devm_device_add_group(&client->dev, &exc3000_attribute_group);