Commit dd24dcf5 authored by Nick Dyer's avatar Nick Dyer Committed by Dmitry Torokhov

Input: atmel_mxt_ts - initialise IRQ before probing

The maXTouch chips use the CHG line to generate status events in bootloader
mode, and during configuration download, before there is enough information
to configure the input device. Therefore set up the interrupt handler
earlier.

However, this introduces states where parts of the interrupt processing
must not run. Use data->object_table as a way to tell whether the chip
information is valid, and data->input_dev as a way to tell whether it is
valid to generate input report.
Signed-off-by: default avatarNick Dyer <nick.dyer@itdev.co.uk>
Acked-by: default avatarBenson Leung <bleung@chromium.org>
Acked-by: default avatarYufeng Shen <miletus@chromium.org>
Signed-off-by: default avatarDmitry Torokhov <dmitry.torokhov@gmail.com>
parent ba4e9a61
...@@ -764,6 +764,12 @@ static irqreturn_t mxt_process_messages_until_invalid(struct mxt_data *data) ...@@ -764,6 +764,12 @@ static irqreturn_t mxt_process_messages_until_invalid(struct mxt_data *data)
if (status & MXT_T6_STATUS_RESET) if (status & MXT_T6_STATUS_RESET)
complete(&data->reset_completion); complete(&data->reset_completion);
} else if (!data->input_dev) {
/*
* do not report events if input device
* is not yet registered
*/
mxt_dump_message(dev, &message);
} else if (mxt_is_T9_message(data, &message)) { } else if (mxt_is_T9_message(data, &message)) {
int id = reportid - data->T9_reportid_min; int id = reportid - data->T9_reportid_min;
mxt_input_touchevent(data, &message, id); mxt_input_touchevent(data, &message, id);
...@@ -792,6 +798,9 @@ static irqreturn_t mxt_interrupt(int irq, void *dev_id) ...@@ -792,6 +798,9 @@ static irqreturn_t mxt_interrupt(int irq, void *dev_id)
return IRQ_HANDLED; return IRQ_HANDLED;
} }
if (!data->object_table)
return IRQ_HANDLED;
return mxt_process_messages_until_invalid(data); return mxt_process_messages_until_invalid(data);
} }
...@@ -942,6 +951,19 @@ static int mxt_make_highchg(struct mxt_data *data) ...@@ -942,6 +951,19 @@ static int mxt_make_highchg(struct mxt_data *data)
return 0; return 0;
} }
static int mxt_acquire_irq(struct mxt_data *data)
{
int error;
enable_irq(data->irq);
error = mxt_make_highchg(data);
if (error)
return error;
return 0;
}
static int mxt_get_info(struct mxt_data *data) static int mxt_get_info(struct mxt_data *data)
{ {
struct i2c_client *client = data->client; struct i2c_client *client = data->client;
...@@ -960,20 +982,29 @@ static int mxt_get_object_table(struct mxt_data *data) ...@@ -960,20 +982,29 @@ static int mxt_get_object_table(struct mxt_data *data)
{ {
struct i2c_client *client = data->client; struct i2c_client *client = data->client;
size_t table_size; size_t table_size;
struct mxt_object *object_table;
int error; int error;
int i; int i;
u8 reportid; u8 reportid;
table_size = data->info.object_num * sizeof(struct mxt_object); table_size = data->info.object_num * sizeof(struct mxt_object);
object_table = kzalloc(table_size, GFP_KERNEL);
if (!object_table) {
dev_err(&data->client->dev, "Failed to allocate memory\n");
return -ENOMEM;
}
error = __mxt_read_reg(client, MXT_OBJECT_START, table_size, error = __mxt_read_reg(client, MXT_OBJECT_START, table_size,
data->object_table); object_table);
if (error) if (error) {
kfree(object_table);
return error; return error;
}
/* Valid Report IDs start counting from 1 */ /* Valid Report IDs start counting from 1 */
reportid = 1; reportid = 1;
for (i = 0; i < data->info.object_num; i++) { for (i = 0; i < data->info.object_num; i++) {
struct mxt_object *object = data->object_table + i; struct mxt_object *object = object_table + i;
u8 min_id, max_id; u8 min_id, max_id;
le16_to_cpus(&object->start_address); le16_to_cpus(&object->start_address);
...@@ -1009,6 +1040,8 @@ static int mxt_get_object_table(struct mxt_data *data) ...@@ -1009,6 +1040,8 @@ static int mxt_get_object_table(struct mxt_data *data)
} }
} }
data->object_table = object_table;
return 0; return 0;
} }
...@@ -1080,21 +1113,17 @@ static int mxt_initialize(struct mxt_data *data) ...@@ -1080,21 +1113,17 @@ static int mxt_initialize(struct mxt_data *data)
if (error) if (error)
return error; return error;
data->object_table = kcalloc(info->object_num,
sizeof(struct mxt_object),
GFP_KERNEL);
if (!data->object_table) {
dev_err(&client->dev, "Failed to allocate memory\n");
return -ENOMEM;
}
/* Get object table information */ /* Get object table information */
error = mxt_get_object_table(data); error = mxt_get_object_table(data);
if (error) { if (error) {
dev_err(&client->dev, "Error %d reading object table\n", error); dev_err(&client->dev, "Error %d reading object table\n", error);
goto err_free_object_table; return error;
} }
mxt_acquire_irq(data);
if (error)
goto err_free_object_table;
/* Check register init values */ /* Check register init values */
error = mxt_check_reg_init(data); error = mxt_check_reg_init(data);
if (error) { if (error) {
...@@ -1345,11 +1374,7 @@ static ssize_t mxt_update_fw_store(struct device *dev, ...@@ -1345,11 +1374,7 @@ static ssize_t mxt_update_fw_store(struct device *dev,
mxt_free_object_table(data); mxt_free_object_table(data);
mxt_initialize(data); error = mxt_initialize(data);
enable_irq(data->irq);
error = mxt_make_highchg(data);
if (error) if (error)
return error; return error;
} }
...@@ -1446,9 +1471,26 @@ static int mxt_probe(struct i2c_client *client, ...@@ -1446,9 +1471,26 @@ static int mxt_probe(struct i2c_client *client,
init_completion(&data->reset_completion); init_completion(&data->reset_completion);
init_completion(&data->crc_completion); init_completion(&data->crc_completion);
error = request_threaded_irq(client->irq, NULL, mxt_interrupt,
pdata->irqflags | IRQF_ONESHOT,
client->name, data);
if (error) {
dev_err(&client->dev, "Failed to register interrupt\n");
goto err_free_mem;
}
disable_irq(client->irq);
error = input_register_device(input_dev);
if (error) {
dev_err(&client->dev, "Error %d registering input device\n",
error);
goto err_free_irq;
}
error = mxt_initialize(data); error = mxt_initialize(data);
if (error) if (error)
goto err_free_mem; goto err_unregister_device;
__set_bit(EV_ABS, input_dev->evbit); __set_bit(EV_ABS, input_dev->evbit);
__set_bit(EV_KEY, input_dev->evbit); __set_bit(EV_KEY, input_dev->evbit);
...@@ -1499,25 +1541,6 @@ static int mxt_probe(struct i2c_client *client, ...@@ -1499,25 +1541,6 @@ static int mxt_probe(struct i2c_client *client,
input_set_drvdata(input_dev, data); input_set_drvdata(input_dev, data);
i2c_set_clientdata(client, data); i2c_set_clientdata(client, data);
error = request_threaded_irq(client->irq, NULL, mxt_interrupt,
pdata->irqflags | IRQF_ONESHOT,
client->name, data);
if (error) {
dev_err(&client->dev, "Failed to register interrupt\n");
goto err_free_object;
}
error = mxt_make_highchg(data);
if (error)
goto err_free_irq;
error = input_register_device(input_dev);
if (error) {
dev_err(&client->dev, "Error %d registering input device\n",
error);
goto err_free_irq;
}
error = sysfs_create_group(&client->dev.kobj, &mxt_attr_group); error = sysfs_create_group(&client->dev.kobj, &mxt_attr_group);
if (error) { if (error) {
dev_err(&client->dev, "Failure %d creating sysfs group\n", dev_err(&client->dev, "Failure %d creating sysfs group\n",
...@@ -1530,10 +1553,10 @@ static int mxt_probe(struct i2c_client *client, ...@@ -1530,10 +1553,10 @@ static int mxt_probe(struct i2c_client *client,
err_unregister_device: err_unregister_device:
input_unregister_device(input_dev); input_unregister_device(input_dev);
input_dev = NULL; input_dev = NULL;
err_free_irq:
free_irq(client->irq, data);
err_free_object: err_free_object:
kfree(data->object_table); kfree(data->object_table);
err_free_irq:
free_irq(client->irq, data);
err_free_mem: err_free_mem:
input_free_device(input_dev); input_free_device(input_dev);
kfree(data); kfree(data);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment