spi: pl022: handle EPROBE_DEFER for dma
[linux/fpc-iii.git] / drivers / input / mouse / elan_i2c_core.c
blob5e1665bbaa0baca86e2c865ba88162be2f209d2e
1 /*
2 * Elan I2C/SMBus Touchpad driver
4 * Copyright (c) 2013 ELAN Microelectronics Corp.
6 * Author: 林政維 (Duson Lin) <dusonlin@emc.com.tw>
7 * Version: 1.6.0
9 * Based on cyapa driver:
10 * copyright (c) 2011-2012 Cypress Semiconductor, Inc.
11 * copyright (c) 2011-2012 Google, Inc.
13 * This program is free software; you can redistribute it and/or modify it
14 * under the terms of the GNU General Public License version 2 as published
15 * by the Free Software Foundation.
17 * Trademarks are the property of their respective owners.
20 #include <linux/acpi.h>
21 #include <linux/delay.h>
22 #include <linux/device.h>
23 #include <linux/firmware.h>
24 #include <linux/i2c.h>
25 #include <linux/init.h>
26 #include <linux/input/mt.h>
27 #include <linux/interrupt.h>
28 #include <linux/module.h>
29 #include <linux/slab.h>
30 #include <linux/kernel.h>
31 #include <linux/sched.h>
32 #include <linux/input.h>
33 #include <linux/uaccess.h>
34 #include <linux/jiffies.h>
35 #include <linux/completion.h>
36 #include <linux/of.h>
37 #include <linux/regulator/consumer.h>
38 #include <asm/unaligned.h>
40 #include "elan_i2c.h"
42 #define DRIVER_NAME "elan_i2c"
43 #define ELAN_DRIVER_VERSION "1.6.1"
44 #define ETP_MAX_PRESSURE 255
45 #define ETP_FWIDTH_REDUCE 90
46 #define ETP_FINGER_WIDTH 15
47 #define ETP_RETRY_COUNT 3
49 #define ETP_MAX_FINGERS 5
50 #define ETP_FINGER_DATA_LEN 5
51 #define ETP_REPORT_ID 0x5D
52 #define ETP_REPORT_ID_OFFSET 2
53 #define ETP_TOUCH_INFO_OFFSET 3
54 #define ETP_FINGER_DATA_OFFSET 4
55 #define ETP_HOVER_INFO_OFFSET 30
56 #define ETP_MAX_REPORT_LEN 34
58 /* The main device structure */
59 struct elan_tp_data {
60 struct i2c_client *client;
61 struct input_dev *input;
62 struct regulator *vcc;
64 const struct elan_transport_ops *ops;
66 /* for fw update */
67 struct completion fw_completion;
68 bool in_fw_update;
70 struct mutex sysfs_mutex;
72 unsigned int max_x;
73 unsigned int max_y;
74 unsigned int width_x;
75 unsigned int width_y;
76 unsigned int x_res;
77 unsigned int y_res;
79 u16 product_id;
80 u8 fw_version;
81 u8 sm_version;
82 u8 iap_version;
83 u16 fw_checksum;
84 int pressure_adjustment;
85 u8 mode;
86 u8 ic_type;
87 u16 fw_validpage_count;
88 u16 fw_signature_address;
90 bool irq_wake;
92 u8 min_baseline;
93 u8 max_baseline;
94 bool baseline_ready;
97 static int elan_get_fwinfo(u8 iap_version, u16 *validpage_count,
98 u16 *signature_address)
100 switch (iap_version) {
101 case 0x00:
102 case 0x06:
103 case 0x08:
104 *validpage_count = 512;
105 break;
106 case 0x03:
107 case 0x07:
108 case 0x09:
109 case 0x0A:
110 case 0x0B:
111 case 0x0C:
112 *validpage_count = 768;
113 break;
114 case 0x0D:
115 *validpage_count = 896;
116 break;
117 case 0x0E:
118 *validpage_count = 640;
119 break;
120 default:
121 /* unknown ic type clear value */
122 *validpage_count = 0;
123 *signature_address = 0;
124 return -ENXIO;
127 *signature_address =
128 (*validpage_count * ETP_FW_PAGE_SIZE) - ETP_FW_SIGNATURE_SIZE;
130 return 0;
133 static int elan_enable_power(struct elan_tp_data *data)
135 int repeat = ETP_RETRY_COUNT;
136 int error;
138 error = regulator_enable(data->vcc);
139 if (error) {
140 dev_err(&data->client->dev,
141 "failed to enable regulator: %d\n", error);
142 return error;
145 do {
146 error = data->ops->power_control(data->client, true);
147 if (error >= 0)
148 return 0;
150 msleep(30);
151 } while (--repeat > 0);
153 dev_err(&data->client->dev, "failed to enable power: %d\n", error);
154 return error;
157 static int elan_disable_power(struct elan_tp_data *data)
159 int repeat = ETP_RETRY_COUNT;
160 int error;
162 do {
163 error = data->ops->power_control(data->client, false);
164 if (!error) {
165 error = regulator_disable(data->vcc);
166 if (error) {
167 dev_err(&data->client->dev,
168 "failed to disable regulator: %d\n",
169 error);
170 /* Attempt to power the chip back up */
171 data->ops->power_control(data->client, true);
172 break;
175 return 0;
178 msleep(30);
179 } while (--repeat > 0);
181 dev_err(&data->client->dev, "failed to disable power: %d\n", error);
182 return error;
185 static int elan_sleep(struct elan_tp_data *data)
187 int repeat = ETP_RETRY_COUNT;
188 int error;
190 do {
191 error = data->ops->sleep_control(data->client, true);
192 if (!error)
193 return 0;
195 msleep(30);
196 } while (--repeat > 0);
198 return error;
201 static int __elan_initialize(struct elan_tp_data *data)
203 struct i2c_client *client = data->client;
204 int error;
206 error = data->ops->initialize(client);
207 if (error) {
208 dev_err(&client->dev, "device initialize failed: %d\n", error);
209 return error;
212 data->mode |= ETP_ENABLE_ABS;
213 error = data->ops->set_mode(client, data->mode);
214 if (error) {
215 dev_err(&client->dev,
216 "failed to switch to absolute mode: %d\n", error);
217 return error;
220 error = data->ops->sleep_control(client, false);
221 if (error) {
222 dev_err(&client->dev,
223 "failed to wake device up: %d\n", error);
224 return error;
227 return 0;
230 static int elan_initialize(struct elan_tp_data *data)
232 int repeat = ETP_RETRY_COUNT;
233 int error;
235 do {
236 error = __elan_initialize(data);
237 if (!error)
238 return 0;
240 msleep(30);
241 } while (--repeat > 0);
243 return error;
246 static int elan_query_device_info(struct elan_tp_data *data)
248 int error;
250 error = data->ops->get_product_id(data->client, &data->product_id);
251 if (error)
252 return error;
254 error = data->ops->get_version(data->client, false, &data->fw_version);
255 if (error)
256 return error;
258 error = data->ops->get_checksum(data->client, false,
259 &data->fw_checksum);
260 if (error)
261 return error;
263 error = data->ops->get_sm_version(data->client, &data->ic_type,
264 &data->sm_version);
265 if (error)
266 return error;
268 error = data->ops->get_version(data->client, true, &data->iap_version);
269 if (error)
270 return error;
272 error = data->ops->get_pressure_adjustment(data->client,
273 &data->pressure_adjustment);
274 if (error)
275 return error;
277 error = elan_get_fwinfo(data->iap_version, &data->fw_validpage_count,
278 &data->fw_signature_address);
279 if (error)
280 dev_warn(&data->client->dev,
281 "unexpected iap version %#04x (ic type: %#04x), firmware update will not work\n",
282 data->iap_version, data->ic_type);
284 return 0;
287 static unsigned int elan_convert_resolution(u8 val)
290 * (value from firmware) * 10 + 790 = dpi
292 * We also have to convert dpi to dots/mm (*10/254 to avoid floating
293 * point).
296 return ((int)(char)val * 10 + 790) * 10 / 254;
299 static int elan_query_device_parameters(struct elan_tp_data *data)
301 unsigned int x_traces, y_traces;
302 u8 hw_x_res, hw_y_res;
303 int error;
305 error = data->ops->get_max(data->client, &data->max_x, &data->max_y);
306 if (error)
307 return error;
309 error = data->ops->get_num_traces(data->client, &x_traces, &y_traces);
310 if (error)
311 return error;
313 data->width_x = data->max_x / x_traces;
314 data->width_y = data->max_y / y_traces;
316 error = data->ops->get_resolution(data->client, &hw_x_res, &hw_y_res);
317 if (error)
318 return error;
320 data->x_res = elan_convert_resolution(hw_x_res);
321 data->y_res = elan_convert_resolution(hw_y_res);
323 return 0;
327 **********************************************************
328 * IAP firmware updater related routines
329 **********************************************************
331 static int elan_write_fw_block(struct elan_tp_data *data,
332 const u8 *page, u16 checksum, int idx)
334 int retry = ETP_RETRY_COUNT;
335 int error;
337 do {
338 error = data->ops->write_fw_block(data->client,
339 page, checksum, idx);
340 if (!error)
341 return 0;
343 dev_dbg(&data->client->dev,
344 "IAP retrying page %d (error: %d)\n", idx, error);
345 } while (--retry > 0);
347 return error;
350 static int __elan_update_firmware(struct elan_tp_data *data,
351 const struct firmware *fw)
353 struct i2c_client *client = data->client;
354 struct device *dev = &client->dev;
355 int i, j;
356 int error;
357 u16 iap_start_addr;
358 u16 boot_page_count;
359 u16 sw_checksum = 0, fw_checksum = 0;
361 error = data->ops->prepare_fw_update(client);
362 if (error)
363 return error;
365 iap_start_addr = get_unaligned_le16(&fw->data[ETP_IAP_START_ADDR * 2]);
367 boot_page_count = (iap_start_addr * 2) / ETP_FW_PAGE_SIZE;
368 for (i = boot_page_count; i < data->fw_validpage_count; i++) {
369 u16 checksum = 0;
370 const u8 *page = &fw->data[i * ETP_FW_PAGE_SIZE];
372 for (j = 0; j < ETP_FW_PAGE_SIZE; j += 2)
373 checksum += ((page[j + 1] << 8) | page[j]);
375 error = elan_write_fw_block(data, page, checksum, i);
376 if (error) {
377 dev_err(dev, "write page %d fail: %d\n", i, error);
378 return error;
381 sw_checksum += checksum;
384 /* Wait WDT reset and power on reset */
385 msleep(600);
387 error = data->ops->finish_fw_update(client, &data->fw_completion);
388 if (error)
389 return error;
391 error = data->ops->get_checksum(client, true, &fw_checksum);
392 if (error)
393 return error;
395 if (sw_checksum != fw_checksum) {
396 dev_err(dev, "checksum diff sw=[%04X], fw=[%04X]\n",
397 sw_checksum, fw_checksum);
398 return -EIO;
401 return 0;
404 static int elan_update_firmware(struct elan_tp_data *data,
405 const struct firmware *fw)
407 struct i2c_client *client = data->client;
408 int retval;
410 dev_dbg(&client->dev, "Starting firmware update....\n");
412 disable_irq(client->irq);
413 data->in_fw_update = true;
415 retval = __elan_update_firmware(data, fw);
416 if (retval) {
417 dev_err(&client->dev, "firmware update failed: %d\n", retval);
418 data->ops->iap_reset(client);
419 } else {
420 /* Reinitialize TP after fw is updated */
421 elan_initialize(data);
422 elan_query_device_info(data);
425 data->in_fw_update = false;
426 enable_irq(client->irq);
428 return retval;
432 *******************************************************************
433 * SYSFS attributes
434 *******************************************************************
436 static ssize_t elan_sysfs_read_fw_checksum(struct device *dev,
437 struct device_attribute *attr,
438 char *buf)
440 struct i2c_client *client = to_i2c_client(dev);
441 struct elan_tp_data *data = i2c_get_clientdata(client);
443 return sprintf(buf, "0x%04x\n", data->fw_checksum);
446 static ssize_t elan_sysfs_read_product_id(struct device *dev,
447 struct device_attribute *attr,
448 char *buf)
450 struct i2c_client *client = to_i2c_client(dev);
451 struct elan_tp_data *data = i2c_get_clientdata(client);
453 return sprintf(buf, ETP_PRODUCT_ID_FORMAT_STRING "\n",
454 data->product_id);
457 static ssize_t elan_sysfs_read_fw_ver(struct device *dev,
458 struct device_attribute *attr,
459 char *buf)
461 struct i2c_client *client = to_i2c_client(dev);
462 struct elan_tp_data *data = i2c_get_clientdata(client);
464 return sprintf(buf, "%d.0\n", data->fw_version);
467 static ssize_t elan_sysfs_read_sm_ver(struct device *dev,
468 struct device_attribute *attr,
469 char *buf)
471 struct i2c_client *client = to_i2c_client(dev);
472 struct elan_tp_data *data = i2c_get_clientdata(client);
474 return sprintf(buf, "%d.0\n", data->sm_version);
477 static ssize_t elan_sysfs_read_iap_ver(struct device *dev,
478 struct device_attribute *attr,
479 char *buf)
481 struct i2c_client *client = to_i2c_client(dev);
482 struct elan_tp_data *data = i2c_get_clientdata(client);
484 return sprintf(buf, "%d.0\n", data->iap_version);
487 static ssize_t elan_sysfs_update_fw(struct device *dev,
488 struct device_attribute *attr,
489 const char *buf, size_t count)
491 struct elan_tp_data *data = dev_get_drvdata(dev);
492 const struct firmware *fw;
493 char *fw_name;
494 int error;
495 const u8 *fw_signature;
496 static const u8 signature[] = {0xAA, 0x55, 0xCC, 0x33, 0xFF, 0xFF};
498 if (data->fw_validpage_count == 0)
499 return -EINVAL;
501 /* Look for a firmware with the product id appended. */
502 fw_name = kasprintf(GFP_KERNEL, ETP_FW_NAME, data->product_id);
503 if (!fw_name) {
504 dev_err(dev, "failed to allocate memory for firmware name\n");
505 return -ENOMEM;
508 dev_info(dev, "requesting fw '%s'\n", fw_name);
509 error = request_firmware(&fw, fw_name, dev);
510 kfree(fw_name);
511 if (error) {
512 dev_err(dev, "failed to request firmware: %d\n", error);
513 return error;
516 /* Firmware file must match signature data */
517 fw_signature = &fw->data[data->fw_signature_address];
518 if (memcmp(fw_signature, signature, sizeof(signature)) != 0) {
519 dev_err(dev, "signature mismatch (expected %*ph, got %*ph)\n",
520 (int)sizeof(signature), signature,
521 (int)sizeof(signature), fw_signature);
522 error = -EBADF;
523 goto out_release_fw;
526 error = mutex_lock_interruptible(&data->sysfs_mutex);
527 if (error)
528 goto out_release_fw;
530 error = elan_update_firmware(data, fw);
532 mutex_unlock(&data->sysfs_mutex);
534 out_release_fw:
535 release_firmware(fw);
536 return error ?: count;
539 static ssize_t calibrate_store(struct device *dev,
540 struct device_attribute *attr,
541 const char *buf, size_t count)
543 struct i2c_client *client = to_i2c_client(dev);
544 struct elan_tp_data *data = i2c_get_clientdata(client);
545 int tries = 20;
546 int retval;
547 int error;
548 u8 val[3];
550 retval = mutex_lock_interruptible(&data->sysfs_mutex);
551 if (retval)
552 return retval;
554 disable_irq(client->irq);
556 data->mode |= ETP_ENABLE_CALIBRATE;
557 retval = data->ops->set_mode(client, data->mode);
558 if (retval) {
559 dev_err(dev, "failed to enable calibration mode: %d\n",
560 retval);
561 goto out;
564 retval = data->ops->calibrate(client);
565 if (retval) {
566 dev_err(dev, "failed to start calibration: %d\n",
567 retval);
568 goto out_disable_calibrate;
571 val[0] = 0xff;
572 do {
573 /* Wait 250ms before checking if calibration has completed. */
574 msleep(250);
576 retval = data->ops->calibrate_result(client, val);
577 if (retval)
578 dev_err(dev, "failed to check calibration result: %d\n",
579 retval);
580 else if (val[0] == 0)
581 break; /* calibration done */
583 } while (--tries);
585 if (tries == 0) {
586 dev_err(dev, "failed to calibrate. Timeout.\n");
587 retval = -ETIMEDOUT;
590 out_disable_calibrate:
591 data->mode &= ~ETP_ENABLE_CALIBRATE;
592 error = data->ops->set_mode(data->client, data->mode);
593 if (error) {
594 dev_err(dev, "failed to disable calibration mode: %d\n",
595 error);
596 if (!retval)
597 retval = error;
599 out:
600 enable_irq(client->irq);
601 mutex_unlock(&data->sysfs_mutex);
602 return retval ?: count;
605 static ssize_t elan_sysfs_read_mode(struct device *dev,
606 struct device_attribute *attr,
607 char *buf)
609 struct i2c_client *client = to_i2c_client(dev);
610 struct elan_tp_data *data = i2c_get_clientdata(client);
611 int error;
612 enum tp_mode mode;
614 error = mutex_lock_interruptible(&data->sysfs_mutex);
615 if (error)
616 return error;
618 error = data->ops->iap_get_mode(data->client, &mode);
620 mutex_unlock(&data->sysfs_mutex);
622 if (error)
623 return error;
625 return sprintf(buf, "%d\n", (int)mode);
628 static DEVICE_ATTR(product_id, S_IRUGO, elan_sysfs_read_product_id, NULL);
629 static DEVICE_ATTR(firmware_version, S_IRUGO, elan_sysfs_read_fw_ver, NULL);
630 static DEVICE_ATTR(sample_version, S_IRUGO, elan_sysfs_read_sm_ver, NULL);
631 static DEVICE_ATTR(iap_version, S_IRUGO, elan_sysfs_read_iap_ver, NULL);
632 static DEVICE_ATTR(fw_checksum, S_IRUGO, elan_sysfs_read_fw_checksum, NULL);
633 static DEVICE_ATTR(mode, S_IRUGO, elan_sysfs_read_mode, NULL);
634 static DEVICE_ATTR(update_fw, S_IWUSR, NULL, elan_sysfs_update_fw);
636 static DEVICE_ATTR_WO(calibrate);
638 static struct attribute *elan_sysfs_entries[] = {
639 &dev_attr_product_id.attr,
640 &dev_attr_firmware_version.attr,
641 &dev_attr_sample_version.attr,
642 &dev_attr_iap_version.attr,
643 &dev_attr_fw_checksum.attr,
644 &dev_attr_calibrate.attr,
645 &dev_attr_mode.attr,
646 &dev_attr_update_fw.attr,
647 NULL,
650 static const struct attribute_group elan_sysfs_group = {
651 .attrs = elan_sysfs_entries,
654 static ssize_t acquire_store(struct device *dev, struct device_attribute *attr,
655 const char *buf, size_t count)
657 struct i2c_client *client = to_i2c_client(dev);
658 struct elan_tp_data *data = i2c_get_clientdata(client);
659 int error;
660 int retval;
662 retval = mutex_lock_interruptible(&data->sysfs_mutex);
663 if (retval)
664 return retval;
666 disable_irq(client->irq);
668 data->baseline_ready = false;
670 data->mode |= ETP_ENABLE_CALIBRATE;
671 retval = data->ops->set_mode(data->client, data->mode);
672 if (retval) {
673 dev_err(dev, "Failed to enable calibration mode to get baseline: %d\n",
674 retval);
675 goto out;
678 msleep(250);
680 retval = data->ops->get_baseline_data(data->client, true,
681 &data->max_baseline);
682 if (retval) {
683 dev_err(dev, "Failed to read max baseline form device: %d\n",
684 retval);
685 goto out_disable_calibrate;
688 retval = data->ops->get_baseline_data(data->client, false,
689 &data->min_baseline);
690 if (retval) {
691 dev_err(dev, "Failed to read min baseline form device: %d\n",
692 retval);
693 goto out_disable_calibrate;
696 data->baseline_ready = true;
698 out_disable_calibrate:
699 data->mode &= ~ETP_ENABLE_CALIBRATE;
700 error = data->ops->set_mode(data->client, data->mode);
701 if (error) {
702 dev_err(dev, "Failed to disable calibration mode after acquiring baseline: %d\n",
703 error);
704 if (!retval)
705 retval = error;
707 out:
708 enable_irq(client->irq);
709 mutex_unlock(&data->sysfs_mutex);
710 return retval ?: count;
713 static ssize_t min_show(struct device *dev,
714 struct device_attribute *attr, char *buf)
716 struct i2c_client *client = to_i2c_client(dev);
717 struct elan_tp_data *data = i2c_get_clientdata(client);
718 int retval;
720 retval = mutex_lock_interruptible(&data->sysfs_mutex);
721 if (retval)
722 return retval;
724 if (!data->baseline_ready) {
725 retval = -ENODATA;
726 goto out;
729 retval = snprintf(buf, PAGE_SIZE, "%d", data->min_baseline);
731 out:
732 mutex_unlock(&data->sysfs_mutex);
733 return retval;
736 static ssize_t max_show(struct device *dev,
737 struct device_attribute *attr, char *buf)
739 struct i2c_client *client = to_i2c_client(dev);
740 struct elan_tp_data *data = i2c_get_clientdata(client);
741 int retval;
743 retval = mutex_lock_interruptible(&data->sysfs_mutex);
744 if (retval)
745 return retval;
747 if (!data->baseline_ready) {
748 retval = -ENODATA;
749 goto out;
752 retval = snprintf(buf, PAGE_SIZE, "%d", data->max_baseline);
754 out:
755 mutex_unlock(&data->sysfs_mutex);
756 return retval;
760 static DEVICE_ATTR_WO(acquire);
761 static DEVICE_ATTR_RO(min);
762 static DEVICE_ATTR_RO(max);
764 static struct attribute *elan_baseline_sysfs_entries[] = {
765 &dev_attr_acquire.attr,
766 &dev_attr_min.attr,
767 &dev_attr_max.attr,
768 NULL,
771 static const struct attribute_group elan_baseline_sysfs_group = {
772 .name = "baseline",
773 .attrs = elan_baseline_sysfs_entries,
776 static const struct attribute_group *elan_sysfs_groups[] = {
777 &elan_sysfs_group,
778 &elan_baseline_sysfs_group,
779 NULL
783 ******************************************************************
784 * Elan isr functions
785 ******************************************************************
787 static void elan_report_contact(struct elan_tp_data *data,
788 int contact_num, bool contact_valid,
789 u8 *finger_data)
791 struct input_dev *input = data->input;
792 unsigned int pos_x, pos_y;
793 unsigned int pressure, mk_x, mk_y;
794 unsigned int area_x, area_y, major, minor;
795 unsigned int scaled_pressure;
797 if (contact_valid) {
798 pos_x = ((finger_data[0] & 0xf0) << 4) |
799 finger_data[1];
800 pos_y = ((finger_data[0] & 0x0f) << 8) |
801 finger_data[2];
802 mk_x = (finger_data[3] & 0x0f);
803 mk_y = (finger_data[3] >> 4);
804 pressure = finger_data[4];
806 if (pos_x > data->max_x || pos_y > data->max_y) {
807 dev_dbg(input->dev.parent,
808 "[%d] x=%d y=%d over max (%d, %d)",
809 contact_num, pos_x, pos_y,
810 data->max_x, data->max_y);
811 return;
815 * To avoid treating large finger as palm, let's reduce the
816 * width x and y per trace.
818 area_x = mk_x * (data->width_x - ETP_FWIDTH_REDUCE);
819 area_y = mk_y * (data->width_y - ETP_FWIDTH_REDUCE);
821 major = max(area_x, area_y);
822 minor = min(area_x, area_y);
824 scaled_pressure = pressure + data->pressure_adjustment;
826 if (scaled_pressure > ETP_MAX_PRESSURE)
827 scaled_pressure = ETP_MAX_PRESSURE;
829 input_mt_slot(input, contact_num);
830 input_mt_report_slot_state(input, MT_TOOL_FINGER, true);
831 input_report_abs(input, ABS_MT_POSITION_X, pos_x);
832 input_report_abs(input, ABS_MT_POSITION_Y, data->max_y - pos_y);
833 input_report_abs(input, ABS_MT_PRESSURE, scaled_pressure);
834 input_report_abs(input, ABS_TOOL_WIDTH, mk_x);
835 input_report_abs(input, ABS_MT_TOUCH_MAJOR, major);
836 input_report_abs(input, ABS_MT_TOUCH_MINOR, minor);
837 } else {
838 input_mt_slot(input, contact_num);
839 input_mt_report_slot_state(input, MT_TOOL_FINGER, false);
843 static void elan_report_absolute(struct elan_tp_data *data, u8 *packet)
845 struct input_dev *input = data->input;
846 u8 *finger_data = &packet[ETP_FINGER_DATA_OFFSET];
847 int i;
848 u8 tp_info = packet[ETP_TOUCH_INFO_OFFSET];
849 u8 hover_info = packet[ETP_HOVER_INFO_OFFSET];
850 bool contact_valid, hover_event;
852 hover_event = hover_info & 0x40;
853 for (i = 0; i < ETP_MAX_FINGERS; i++) {
854 contact_valid = tp_info & (1U << (3 + i));
855 elan_report_contact(data, i, contact_valid, finger_data);
857 if (contact_valid)
858 finger_data += ETP_FINGER_DATA_LEN;
861 input_report_key(input, BTN_LEFT, tp_info & 0x01);
862 input_report_abs(input, ABS_DISTANCE, hover_event != 0);
863 input_mt_report_pointer_emulation(input, true);
864 input_sync(input);
867 static irqreturn_t elan_isr(int irq, void *dev_id)
869 struct elan_tp_data *data = dev_id;
870 struct device *dev = &data->client->dev;
871 int error;
872 u8 report[ETP_MAX_REPORT_LEN];
875 * When device is connected to i2c bus, when all IAP page writes
876 * complete, the driver will receive interrupt and must read
877 * 0000 to confirm that IAP is finished.
879 if (data->in_fw_update) {
880 complete(&data->fw_completion);
881 goto out;
884 error = data->ops->get_report(data->client, report);
885 if (error)
886 goto out;
888 if (report[ETP_REPORT_ID_OFFSET] != ETP_REPORT_ID)
889 dev_err(dev, "invalid report id data (%x)\n",
890 report[ETP_REPORT_ID_OFFSET]);
891 else
892 elan_report_absolute(data, report);
894 out:
895 return IRQ_HANDLED;
899 ******************************************************************
900 * Elan initialization functions
901 ******************************************************************
903 static int elan_setup_input_device(struct elan_tp_data *data)
905 struct device *dev = &data->client->dev;
906 struct input_dev *input;
907 unsigned int max_width = max(data->width_x, data->width_y);
908 unsigned int min_width = min(data->width_x, data->width_y);
909 int error;
911 input = devm_input_allocate_device(dev);
912 if (!input)
913 return -ENOMEM;
915 input->name = "Elan Touchpad";
916 input->id.bustype = BUS_I2C;
917 input_set_drvdata(input, data);
919 error = input_mt_init_slots(input, ETP_MAX_FINGERS,
920 INPUT_MT_POINTER | INPUT_MT_DROP_UNUSED);
921 if (error) {
922 dev_err(dev, "failed to initialize MT slots: %d\n", error);
923 return error;
926 __set_bit(EV_ABS, input->evbit);
927 __set_bit(INPUT_PROP_POINTER, input->propbit);
928 __set_bit(INPUT_PROP_BUTTONPAD, input->propbit);
929 __set_bit(BTN_LEFT, input->keybit);
931 /* Set up ST parameters */
932 input_set_abs_params(input, ABS_X, 0, data->max_x, 0, 0);
933 input_set_abs_params(input, ABS_Y, 0, data->max_y, 0, 0);
934 input_abs_set_res(input, ABS_X, data->x_res);
935 input_abs_set_res(input, ABS_Y, data->y_res);
936 input_set_abs_params(input, ABS_PRESSURE, 0, ETP_MAX_PRESSURE, 0, 0);
937 input_set_abs_params(input, ABS_TOOL_WIDTH, 0, ETP_FINGER_WIDTH, 0, 0);
938 input_set_abs_params(input, ABS_DISTANCE, 0, 1, 0, 0);
940 /* And MT parameters */
941 input_set_abs_params(input, ABS_MT_POSITION_X, 0, data->max_x, 0, 0);
942 input_set_abs_params(input, ABS_MT_POSITION_Y, 0, data->max_y, 0, 0);
943 input_abs_set_res(input, ABS_MT_POSITION_X, data->x_res);
944 input_abs_set_res(input, ABS_MT_POSITION_Y, data->y_res);
945 input_set_abs_params(input, ABS_MT_PRESSURE, 0,
946 ETP_MAX_PRESSURE, 0, 0);
947 input_set_abs_params(input, ABS_MT_TOUCH_MAJOR, 0,
948 ETP_FINGER_WIDTH * max_width, 0, 0);
949 input_set_abs_params(input, ABS_MT_TOUCH_MINOR, 0,
950 ETP_FINGER_WIDTH * min_width, 0, 0);
952 data->input = input;
954 return 0;
957 static void elan_disable_regulator(void *_data)
959 struct elan_tp_data *data = _data;
961 regulator_disable(data->vcc);
964 static void elan_remove_sysfs_groups(void *_data)
966 struct elan_tp_data *data = _data;
968 sysfs_remove_groups(&data->client->dev.kobj, elan_sysfs_groups);
971 static int elan_probe(struct i2c_client *client,
972 const struct i2c_device_id *dev_id)
974 const struct elan_transport_ops *transport_ops;
975 struct device *dev = &client->dev;
976 struct elan_tp_data *data;
977 unsigned long irqflags;
978 int error;
980 if (IS_ENABLED(CONFIG_MOUSE_ELAN_I2C_I2C) &&
981 i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
982 transport_ops = &elan_i2c_ops;
983 } else if (IS_ENABLED(CONFIG_MOUSE_ELAN_I2C_SMBUS) &&
984 i2c_check_functionality(client->adapter,
985 I2C_FUNC_SMBUS_BYTE_DATA |
986 I2C_FUNC_SMBUS_BLOCK_DATA |
987 I2C_FUNC_SMBUS_I2C_BLOCK)) {
988 transport_ops = &elan_smbus_ops;
989 } else {
990 dev_err(dev, "not a supported I2C/SMBus adapter\n");
991 return -EIO;
994 data = devm_kzalloc(&client->dev, sizeof(struct elan_tp_data),
995 GFP_KERNEL);
996 if (!data)
997 return -ENOMEM;
999 i2c_set_clientdata(client, data);
1001 data->ops = transport_ops;
1002 data->client = client;
1003 init_completion(&data->fw_completion);
1004 mutex_init(&data->sysfs_mutex);
1006 data->vcc = devm_regulator_get(&client->dev, "vcc");
1007 if (IS_ERR(data->vcc)) {
1008 error = PTR_ERR(data->vcc);
1009 if (error != -EPROBE_DEFER)
1010 dev_err(&client->dev,
1011 "Failed to get 'vcc' regulator: %d\n",
1012 error);
1013 return error;
1016 error = regulator_enable(data->vcc);
1017 if (error) {
1018 dev_err(&client->dev,
1019 "Failed to enable regulator: %d\n", error);
1020 return error;
1023 error = devm_add_action(&client->dev,
1024 elan_disable_regulator, data);
1025 if (error) {
1026 regulator_disable(data->vcc);
1027 dev_err(&client->dev,
1028 "Failed to add disable regulator action: %d\n",
1029 error);
1030 return error;
1033 /* Initialize the touchpad. */
1034 error = elan_initialize(data);
1035 if (error)
1036 return error;
1038 error = elan_query_device_info(data);
1039 if (error)
1040 return error;
1042 error = elan_query_device_parameters(data);
1043 if (error)
1044 return error;
1046 dev_dbg(&client->dev,
1047 "Elan Touchpad Information:\n"
1048 " Module product ID: 0x%04x\n"
1049 " Firmware Version: 0x%04x\n"
1050 " Sample Version: 0x%04x\n"
1051 " IAP Version: 0x%04x\n"
1052 " Max ABS X,Y: %d,%d\n"
1053 " Width X,Y: %d,%d\n"
1054 " Resolution X,Y: %d,%d (dots/mm)\n",
1055 data->product_id,
1056 data->fw_version,
1057 data->sm_version,
1058 data->iap_version,
1059 data->max_x, data->max_y,
1060 data->width_x, data->width_y,
1061 data->x_res, data->y_res);
1063 /* Set up input device properties based on queried parameters. */
1064 error = elan_setup_input_device(data);
1065 if (error)
1066 return error;
1069 * Systems using device tree should set up interrupt via DTS,
1070 * the rest will use the default falling edge interrupts.
1072 irqflags = client->dev.of_node ? 0 : IRQF_TRIGGER_FALLING;
1074 error = devm_request_threaded_irq(&client->dev, client->irq,
1075 NULL, elan_isr,
1076 irqflags | IRQF_ONESHOT,
1077 client->name, data);
1078 if (error) {
1079 dev_err(&client->dev, "cannot register irq=%d\n", client->irq);
1080 return error;
1083 error = sysfs_create_groups(&client->dev.kobj, elan_sysfs_groups);
1084 if (error) {
1085 dev_err(&client->dev, "failed to create sysfs attributes: %d\n",
1086 error);
1087 return error;
1090 error = devm_add_action(&client->dev,
1091 elan_remove_sysfs_groups, data);
1092 if (error) {
1093 elan_remove_sysfs_groups(data);
1094 dev_err(&client->dev,
1095 "Failed to add sysfs cleanup action: %d\n",
1096 error);
1097 return error;
1100 error = input_register_device(data->input);
1101 if (error) {
1102 dev_err(&client->dev, "failed to register input device: %d\n",
1103 error);
1104 return error;
1108 * Systems using device tree should set up wakeup via DTS,
1109 * the rest will configure device as wakeup source by default.
1111 if (!client->dev.of_node)
1112 device_init_wakeup(&client->dev, true);
1114 return 0;
1117 static int __maybe_unused elan_suspend(struct device *dev)
1119 struct i2c_client *client = to_i2c_client(dev);
1120 struct elan_tp_data *data = i2c_get_clientdata(client);
1121 int ret;
1124 * We are taking the mutex to make sure sysfs operations are
1125 * complete before we attempt to bring the device into low[er]
1126 * power mode.
1128 ret = mutex_lock_interruptible(&data->sysfs_mutex);
1129 if (ret)
1130 return ret;
1132 disable_irq(client->irq);
1134 if (device_may_wakeup(dev)) {
1135 ret = elan_sleep(data);
1136 /* Enable wake from IRQ */
1137 data->irq_wake = (enable_irq_wake(client->irq) == 0);
1138 } else {
1139 ret = elan_disable_power(data);
1142 mutex_unlock(&data->sysfs_mutex);
1143 return ret;
1146 static int __maybe_unused elan_resume(struct device *dev)
1148 struct i2c_client *client = to_i2c_client(dev);
1149 struct elan_tp_data *data = i2c_get_clientdata(client);
1150 int error;
1152 if (device_may_wakeup(dev) && data->irq_wake) {
1153 disable_irq_wake(client->irq);
1154 data->irq_wake = false;
1157 error = elan_enable_power(data);
1158 if (error) {
1159 dev_err(dev, "power up when resuming failed: %d\n", error);
1160 goto err;
1163 error = elan_initialize(data);
1164 if (error)
1165 dev_err(dev, "initialize when resuming failed: %d\n", error);
1167 err:
1168 enable_irq(data->client->irq);
1169 return error;
1172 static SIMPLE_DEV_PM_OPS(elan_pm_ops, elan_suspend, elan_resume);
1174 static const struct i2c_device_id elan_id[] = {
1175 { DRIVER_NAME, 0 },
1176 { },
1178 MODULE_DEVICE_TABLE(i2c, elan_id);
1180 #ifdef CONFIG_ACPI
1181 static const struct acpi_device_id elan_acpi_id[] = {
1182 { "ELAN0000", 0 },
1183 { "ELAN0100", 0 },
1184 { "ELAN0600", 0 },
1185 { "ELAN1000", 0 },
1188 MODULE_DEVICE_TABLE(acpi, elan_acpi_id);
1189 #endif
1191 #ifdef CONFIG_OF
1192 static const struct of_device_id elan_of_match[] = {
1193 { .compatible = "elan,ekth3000" },
1194 { /* sentinel */ }
1196 MODULE_DEVICE_TABLE(of, elan_of_match);
1197 #endif
1199 static struct i2c_driver elan_driver = {
1200 .driver = {
1201 .name = DRIVER_NAME,
1202 .pm = &elan_pm_ops,
1203 .acpi_match_table = ACPI_PTR(elan_acpi_id),
1204 .of_match_table = of_match_ptr(elan_of_match),
1205 .probe_type = PROBE_PREFER_ASYNCHRONOUS,
1207 .probe = elan_probe,
1208 .id_table = elan_id,
1211 module_i2c_driver(elan_driver);
1213 MODULE_AUTHOR("Duson Lin <dusonlin@emc.com.tw>");
1214 MODULE_DESCRIPTION("Elan I2C/SMBus Touchpad driver");
1215 MODULE_LICENSE("GPL");
1216 MODULE_VERSION(ELAN_DRIVER_VERSION);