elan_i2c_core.c 34 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Elan I2C/SMBus Touchpad driver
  4. *
  5. * Copyright (c) 2013 ELAN Microelectronics Corp.
  6. *
  7. * Author: 林政維 (Duson Lin) <dusonlin@emc.com.tw>
  8. * Author: KT Liao <kt.liao@emc.com.tw>
  9. * Version: 1.6.3
  10. *
  11. * Based on cyapa driver:
  12. * copyright (c) 2011-2012 Cypress Semiconductor, Inc.
  13. * copyright (c) 2011-2012 Google, Inc.
  14. *
  15. * Trademarks are the property of their respective owners.
  16. */
  17. #include <linux/acpi.h>
  18. #include <linux/delay.h>
  19. #include <linux/device.h>
  20. #include <linux/firmware.h>
  21. #include <linux/i2c.h>
  22. #include <linux/init.h>
  23. #include <linux/input/mt.h>
  24. #include <linux/interrupt.h>
  25. #include <linux/irq.h>
  26. #include <linux/module.h>
  27. #include <linux/slab.h>
  28. #include <linux/kernel.h>
  29. #include <linux/sched.h>
  30. #include <linux/input.h>
  31. #include <linux/uaccess.h>
  32. #include <linux/jiffies.h>
  33. #include <linux/completion.h>
  34. #include <linux/of.h>
  35. #include <linux/property.h>
  36. #include <linux/input/elan-i2c-ids.h>
  37. #include <linux/regulator/consumer.h>
  38. #include <asm/unaligned.h>
  39. #include "elan_i2c.h"
  40. #define DRIVER_NAME "elan_i2c"
  41. #define ELAN_VENDOR_ID 0x04f3
  42. #define ETP_MAX_PRESSURE 255
  43. #define ETP_FWIDTH_REDUCE 90
  44. #define ETP_FINGER_WIDTH 15
  45. #define ETP_RETRY_COUNT 3
  46. /* The main device structure */
  47. struct elan_tp_data {
  48. struct i2c_client *client;
  49. struct input_dev *input;
  50. struct input_dev *tp_input; /* trackpoint input node */
  51. struct regulator *vcc;
  52. const struct elan_transport_ops *ops;
  53. /* for fw update */
  54. struct completion fw_completion;
  55. bool in_fw_update;
  56. struct mutex sysfs_mutex;
  57. unsigned int max_x;
  58. unsigned int max_y;
  59. unsigned int width_x;
  60. unsigned int width_y;
  61. unsigned int x_res;
  62. unsigned int y_res;
  63. u8 pattern;
  64. u16 product_id;
  65. u8 fw_version;
  66. u8 sm_version;
  67. u8 iap_version;
  68. u16 fw_checksum;
  69. unsigned int report_features;
  70. unsigned int report_len;
  71. int pressure_adjustment;
  72. u8 mode;
  73. u16 ic_type;
  74. u16 fw_validpage_count;
  75. u16 fw_page_size;
  76. u32 fw_signature_address;
  77. bool irq_wake;
  78. u8 min_baseline;
  79. u8 max_baseline;
  80. bool baseline_ready;
  81. u8 clickpad;
  82. bool middle_button;
  83. };
  84. static int elan_get_fwinfo(u16 ic_type, u8 iap_version, u16 *validpage_count,
  85. u32 *signature_address, u16 *page_size)
  86. {
  87. switch (ic_type) {
  88. case 0x00:
  89. case 0x06:
  90. case 0x08:
  91. *validpage_count = 512;
  92. break;
  93. case 0x03:
  94. case 0x07:
  95. case 0x09:
  96. case 0x0A:
  97. case 0x0B:
  98. case 0x0C:
  99. *validpage_count = 768;
  100. break;
  101. case 0x0D:
  102. *validpage_count = 896;
  103. break;
  104. case 0x0E:
  105. *validpage_count = 640;
  106. break;
  107. case 0x10:
  108. *validpage_count = 1024;
  109. break;
  110. case 0x11:
  111. *validpage_count = 1280;
  112. break;
  113. case 0x13:
  114. *validpage_count = 2048;
  115. break;
  116. case 0x14:
  117. case 0x15:
  118. *validpage_count = 1024;
  119. break;
  120. default:
  121. /* unknown ic type clear value */
  122. *validpage_count = 0;
  123. *signature_address = 0;
  124. *page_size = 0;
  125. return -ENXIO;
  126. }
  127. *signature_address =
  128. (*validpage_count * ETP_FW_PAGE_SIZE) - ETP_FW_SIGNATURE_SIZE;
  129. if ((ic_type == 0x14 || ic_type == 0x15) && iap_version >= 2) {
  130. *validpage_count /= 8;
  131. *page_size = ETP_FW_PAGE_SIZE_512;
  132. } else if (ic_type >= 0x0D && iap_version >= 1) {
  133. *validpage_count /= 2;
  134. *page_size = ETP_FW_PAGE_SIZE_128;
  135. } else {
  136. *page_size = ETP_FW_PAGE_SIZE;
  137. }
  138. return 0;
  139. }
  140. static int elan_set_power(struct elan_tp_data *data, bool on)
  141. {
  142. int repeat = ETP_RETRY_COUNT;
  143. int error;
  144. do {
  145. error = data->ops->power_control(data->client, on);
  146. if (error >= 0)
  147. return 0;
  148. msleep(30);
  149. } while (--repeat > 0);
  150. dev_err(&data->client->dev, "failed to set power %s: %d\n",
  151. on ? "on" : "off", error);
  152. return error;
  153. }
  154. static int elan_sleep(struct elan_tp_data *data)
  155. {
  156. int repeat = ETP_RETRY_COUNT;
  157. int error;
  158. do {
  159. error = data->ops->sleep_control(data->client, true);
  160. if (!error)
  161. return 0;
  162. msleep(30);
  163. } while (--repeat > 0);
  164. return error;
  165. }
  166. static int elan_query_product(struct elan_tp_data *data)
  167. {
  168. int error;
  169. error = data->ops->get_product_id(data->client, &data->product_id);
  170. if (error)
  171. return error;
  172. error = data->ops->get_pattern(data->client, &data->pattern);
  173. if (error)
  174. return error;
  175. error = data->ops->get_sm_version(data->client, data->pattern,
  176. &data->ic_type, &data->sm_version,
  177. &data->clickpad);
  178. if (error)
  179. return error;
  180. return 0;
  181. }
  182. static int elan_check_ASUS_special_fw(struct elan_tp_data *data)
  183. {
  184. if (data->ic_type == 0x0E) {
  185. switch (data->product_id) {
  186. case 0x05 ... 0x07:
  187. case 0x09:
  188. case 0x13:
  189. return true;
  190. }
  191. } else if (data->ic_type == 0x08 && data->product_id == 0x26) {
  192. /* ASUS EeeBook X205TA */
  193. return true;
  194. }
  195. return false;
  196. }
  197. static int __elan_initialize(struct elan_tp_data *data)
  198. {
  199. struct i2c_client *client = data->client;
  200. bool woken_up = false;
  201. int error;
  202. error = data->ops->initialize(client);
  203. if (error) {
  204. dev_err(&client->dev, "device initialize failed: %d\n", error);
  205. return error;
  206. }
  207. error = elan_query_product(data);
  208. if (error)
  209. return error;
  210. /*
  211. * Some ASUS devices were shipped with firmware that requires
  212. * touchpads to be woken up first, before attempting to switch
  213. * them into absolute reporting mode.
  214. */
  215. if (elan_check_ASUS_special_fw(data)) {
  216. error = data->ops->sleep_control(client, false);
  217. if (error) {
  218. dev_err(&client->dev,
  219. "failed to wake device up: %d\n", error);
  220. return error;
  221. }
  222. msleep(200);
  223. woken_up = true;
  224. }
  225. data->mode |= ETP_ENABLE_ABS;
  226. error = data->ops->set_mode(client, data->mode);
  227. if (error) {
  228. dev_err(&client->dev,
  229. "failed to switch to absolute mode: %d\n", error);
  230. return error;
  231. }
  232. if (!woken_up) {
  233. error = data->ops->sleep_control(client, false);
  234. if (error) {
  235. dev_err(&client->dev,
  236. "failed to wake device up: %d\n", error);
  237. return error;
  238. }
  239. }
  240. return 0;
  241. }
  242. static int elan_initialize(struct elan_tp_data *data)
  243. {
  244. int repeat = ETP_RETRY_COUNT;
  245. int error;
  246. do {
  247. error = __elan_initialize(data);
  248. if (!error)
  249. return 0;
  250. msleep(30);
  251. } while (--repeat > 0);
  252. return error;
  253. }
  254. static int elan_query_device_info(struct elan_tp_data *data)
  255. {
  256. int error;
  257. error = data->ops->get_version(data->client, data->pattern, false,
  258. &data->fw_version);
  259. if (error)
  260. return error;
  261. error = data->ops->get_checksum(data->client, false,
  262. &data->fw_checksum);
  263. if (error)
  264. return error;
  265. error = data->ops->get_version(data->client, data->pattern,
  266. true, &data->iap_version);
  267. if (error)
  268. return error;
  269. error = data->ops->get_pressure_adjustment(data->client,
  270. &data->pressure_adjustment);
  271. if (error)
  272. return error;
  273. error = data->ops->get_report_features(data->client, data->pattern,
  274. &data->report_features,
  275. &data->report_len);
  276. if (error)
  277. return error;
  278. error = elan_get_fwinfo(data->ic_type, data->iap_version,
  279. &data->fw_validpage_count,
  280. &data->fw_signature_address,
  281. &data->fw_page_size);
  282. if (error)
  283. dev_warn(&data->client->dev,
  284. "unexpected iap version %#04x (ic type: %#04x), firmware update will not work\n",
  285. data->iap_version, data->ic_type);
  286. return 0;
  287. }
  288. static unsigned int elan_convert_resolution(u8 val, u8 pattern)
  289. {
  290. /*
  291. * pattern <= 0x01:
  292. * (value from firmware) * 10 + 790 = dpi
  293. * else
  294. * ((value from firmware) + 3) * 100 = dpi
  295. */
  296. int res = pattern <= 0x01 ?
  297. (int)(char)val * 10 + 790 : ((int)(char)val + 3) * 100;
  298. /*
  299. * We also have to convert dpi to dots/mm (*10/254 to avoid floating
  300. * point).
  301. */
  302. return res * 10 / 254;
  303. }
  304. static int elan_query_device_parameters(struct elan_tp_data *data)
  305. {
  306. struct i2c_client *client = data->client;
  307. unsigned int x_traces, y_traces;
  308. u32 x_mm, y_mm;
  309. u8 hw_x_res, hw_y_res;
  310. int error;
  311. if (device_property_read_u32(&client->dev,
  312. "touchscreen-size-x", &data->max_x) ||
  313. device_property_read_u32(&client->dev,
  314. "touchscreen-size-y", &data->max_y)) {
  315. error = data->ops->get_max(data->client,
  316. &data->max_x,
  317. &data->max_y);
  318. if (error)
  319. return error;
  320. } else {
  321. /* size is the maximum + 1 */
  322. --data->max_x;
  323. --data->max_y;
  324. }
  325. if (device_property_read_u32(&client->dev,
  326. "elan,x_traces",
  327. &x_traces) ||
  328. device_property_read_u32(&client->dev,
  329. "elan,y_traces",
  330. &y_traces)) {
  331. error = data->ops->get_num_traces(data->client,
  332. &x_traces, &y_traces);
  333. if (error)
  334. return error;
  335. }
  336. data->width_x = data->max_x / x_traces;
  337. data->width_y = data->max_y / y_traces;
  338. if (device_property_read_u32(&client->dev,
  339. "touchscreen-x-mm", &x_mm) ||
  340. device_property_read_u32(&client->dev,
  341. "touchscreen-y-mm", &y_mm)) {
  342. error = data->ops->get_resolution(data->client,
  343. &hw_x_res, &hw_y_res);
  344. if (error)
  345. return error;
  346. data->x_res = elan_convert_resolution(hw_x_res, data->pattern);
  347. data->y_res = elan_convert_resolution(hw_y_res, data->pattern);
  348. } else {
  349. data->x_res = (data->max_x + 1) / x_mm;
  350. data->y_res = (data->max_y + 1) / y_mm;
  351. }
  352. if (device_property_read_bool(&client->dev, "elan,clickpad"))
  353. data->clickpad = 1;
  354. if (device_property_read_bool(&client->dev, "elan,middle-button"))
  355. data->middle_button = true;
  356. return 0;
  357. }
  358. /*
  359. **********************************************************
  360. * IAP firmware updater related routines
  361. **********************************************************
  362. */
  363. static int elan_write_fw_block(struct elan_tp_data *data, u16 page_size,
  364. const u8 *page, u16 checksum, int idx)
  365. {
  366. int retry = ETP_RETRY_COUNT;
  367. int error;
  368. do {
  369. error = data->ops->write_fw_block(data->client, page_size,
  370. page, checksum, idx);
  371. if (!error)
  372. return 0;
  373. dev_dbg(&data->client->dev,
  374. "IAP retrying page %d (error: %d)\n", idx, error);
  375. } while (--retry > 0);
  376. return error;
  377. }
  378. static int __elan_update_firmware(struct elan_tp_data *data,
  379. const struct firmware *fw)
  380. {
  381. struct i2c_client *client = data->client;
  382. struct device *dev = &client->dev;
  383. int i, j;
  384. int error;
  385. u16 iap_start_addr;
  386. u16 boot_page_count;
  387. u16 sw_checksum = 0, fw_checksum = 0;
  388. error = data->ops->prepare_fw_update(client, data->ic_type,
  389. data->iap_version,
  390. data->fw_page_size);
  391. if (error)
  392. return error;
  393. iap_start_addr = get_unaligned_le16(&fw->data[ETP_IAP_START_ADDR * 2]);
  394. boot_page_count = (iap_start_addr * 2) / data->fw_page_size;
  395. for (i = boot_page_count; i < data->fw_validpage_count; i++) {
  396. u16 checksum = 0;
  397. const u8 *page = &fw->data[i * data->fw_page_size];
  398. for (j = 0; j < data->fw_page_size; j += 2)
  399. checksum += ((page[j + 1] << 8) | page[j]);
  400. error = elan_write_fw_block(data, data->fw_page_size,
  401. page, checksum, i);
  402. if (error) {
  403. dev_err(dev, "write page %d fail: %d\n", i, error);
  404. return error;
  405. }
  406. sw_checksum += checksum;
  407. }
  408. /* Wait WDT reset and power on reset */
  409. msleep(600);
  410. error = data->ops->finish_fw_update(client, &data->fw_completion);
  411. if (error)
  412. return error;
  413. error = data->ops->get_checksum(client, true, &fw_checksum);
  414. if (error)
  415. return error;
  416. if (sw_checksum != fw_checksum) {
  417. dev_err(dev, "checksum diff sw=[%04X], fw=[%04X]\n",
  418. sw_checksum, fw_checksum);
  419. return -EIO;
  420. }
  421. return 0;
  422. }
  423. static int elan_update_firmware(struct elan_tp_data *data,
  424. const struct firmware *fw)
  425. {
  426. struct i2c_client *client = data->client;
  427. int retval;
  428. dev_dbg(&client->dev, "Starting firmware update....\n");
  429. disable_irq(client->irq);
  430. data->in_fw_update = true;
  431. retval = __elan_update_firmware(data, fw);
  432. if (retval) {
  433. dev_err(&client->dev, "firmware update failed: %d\n", retval);
  434. data->ops->iap_reset(client);
  435. } else {
  436. /* Reinitialize TP after fw is updated */
  437. elan_initialize(data);
  438. elan_query_device_info(data);
  439. }
  440. data->in_fw_update = false;
  441. enable_irq(client->irq);
  442. return retval;
  443. }
  444. /*
  445. *******************************************************************
  446. * SYSFS attributes
  447. *******************************************************************
  448. */
  449. static ssize_t elan_sysfs_read_fw_checksum(struct device *dev,
  450. struct device_attribute *attr,
  451. char *buf)
  452. {
  453. struct i2c_client *client = to_i2c_client(dev);
  454. struct elan_tp_data *data = i2c_get_clientdata(client);
  455. return sprintf(buf, "0x%04x\n", data->fw_checksum);
  456. }
  457. static ssize_t elan_sysfs_read_product_id(struct device *dev,
  458. struct device_attribute *attr,
  459. char *buf)
  460. {
  461. struct i2c_client *client = to_i2c_client(dev);
  462. struct elan_tp_data *data = i2c_get_clientdata(client);
  463. return sprintf(buf, ETP_PRODUCT_ID_FORMAT_STRING "\n",
  464. data->product_id);
  465. }
  466. static ssize_t elan_sysfs_read_fw_ver(struct device *dev,
  467. struct device_attribute *attr,
  468. char *buf)
  469. {
  470. struct i2c_client *client = to_i2c_client(dev);
  471. struct elan_tp_data *data = i2c_get_clientdata(client);
  472. return sprintf(buf, "%d.0\n", data->fw_version);
  473. }
  474. static ssize_t elan_sysfs_read_sm_ver(struct device *dev,
  475. struct device_attribute *attr,
  476. char *buf)
  477. {
  478. struct i2c_client *client = to_i2c_client(dev);
  479. struct elan_tp_data *data = i2c_get_clientdata(client);
  480. return sprintf(buf, "%d.0\n", data->sm_version);
  481. }
  482. static ssize_t elan_sysfs_read_iap_ver(struct device *dev,
  483. struct device_attribute *attr,
  484. char *buf)
  485. {
  486. struct i2c_client *client = to_i2c_client(dev);
  487. struct elan_tp_data *data = i2c_get_clientdata(client);
  488. return sprintf(buf, "%d.0\n", data->iap_version);
  489. }
  490. static ssize_t elan_sysfs_update_fw(struct device *dev,
  491. struct device_attribute *attr,
  492. const char *buf, size_t count)
  493. {
  494. struct elan_tp_data *data = dev_get_drvdata(dev);
  495. const struct firmware *fw;
  496. char *fw_name;
  497. int error;
  498. const u8 *fw_signature;
  499. static const u8 signature[] = {0xAA, 0x55, 0xCC, 0x33, 0xFF, 0xFF};
  500. if (data->fw_validpage_count == 0)
  501. return -EINVAL;
  502. /* Look for a firmware with the product id appended. */
  503. fw_name = kasprintf(GFP_KERNEL, ETP_FW_NAME, data->product_id);
  504. if (!fw_name) {
  505. dev_err(dev, "failed to allocate memory for firmware name\n");
  506. return -ENOMEM;
  507. }
  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;
  514. }
  515. /* Firmware file must match signature data */
  516. fw_signature = &fw->data[data->fw_signature_address];
  517. if (memcmp(fw_signature, signature, sizeof(signature)) != 0) {
  518. dev_err(dev, "signature mismatch (expected %*ph, got %*ph)\n",
  519. (int)sizeof(signature), signature,
  520. (int)sizeof(signature), fw_signature);
  521. error = -EBADF;
  522. goto out_release_fw;
  523. }
  524. error = mutex_lock_interruptible(&data->sysfs_mutex);
  525. if (error)
  526. goto out_release_fw;
  527. error = elan_update_firmware(data, fw);
  528. mutex_unlock(&data->sysfs_mutex);
  529. out_release_fw:
  530. release_firmware(fw);
  531. return error ?: count;
  532. }
  533. static ssize_t calibrate_store(struct device *dev,
  534. struct device_attribute *attr,
  535. const char *buf, size_t count)
  536. {
  537. struct i2c_client *client = to_i2c_client(dev);
  538. struct elan_tp_data *data = i2c_get_clientdata(client);
  539. int tries = 20;
  540. int retval;
  541. int error;
  542. u8 val[ETP_CALIBRATE_MAX_LEN];
  543. retval = mutex_lock_interruptible(&data->sysfs_mutex);
  544. if (retval)
  545. return retval;
  546. disable_irq(client->irq);
  547. data->mode |= ETP_ENABLE_CALIBRATE;
  548. retval = data->ops->set_mode(client, data->mode);
  549. if (retval) {
  550. dev_err(dev, "failed to enable calibration mode: %d\n",
  551. retval);
  552. goto out;
  553. }
  554. retval = data->ops->calibrate(client);
  555. if (retval) {
  556. dev_err(dev, "failed to start calibration: %d\n",
  557. retval);
  558. goto out_disable_calibrate;
  559. }
  560. val[0] = 0xff;
  561. do {
  562. /* Wait 250ms before checking if calibration has completed. */
  563. msleep(250);
  564. retval = data->ops->calibrate_result(client, val);
  565. if (retval)
  566. dev_err(dev, "failed to check calibration result: %d\n",
  567. retval);
  568. else if (val[0] == 0)
  569. break; /* calibration done */
  570. } while (--tries);
  571. if (tries == 0) {
  572. dev_err(dev, "failed to calibrate. Timeout.\n");
  573. retval = -ETIMEDOUT;
  574. }
  575. out_disable_calibrate:
  576. data->mode &= ~ETP_ENABLE_CALIBRATE;
  577. error = data->ops->set_mode(data->client, data->mode);
  578. if (error) {
  579. dev_err(dev, "failed to disable calibration mode: %d\n",
  580. error);
  581. if (!retval)
  582. retval = error;
  583. }
  584. out:
  585. enable_irq(client->irq);
  586. mutex_unlock(&data->sysfs_mutex);
  587. return retval ?: count;
  588. }
  589. static ssize_t elan_sysfs_read_mode(struct device *dev,
  590. struct device_attribute *attr,
  591. char *buf)
  592. {
  593. struct i2c_client *client = to_i2c_client(dev);
  594. struct elan_tp_data *data = i2c_get_clientdata(client);
  595. int error;
  596. enum tp_mode mode;
  597. error = mutex_lock_interruptible(&data->sysfs_mutex);
  598. if (error)
  599. return error;
  600. error = data->ops->iap_get_mode(data->client, &mode);
  601. mutex_unlock(&data->sysfs_mutex);
  602. if (error)
  603. return error;
  604. return sprintf(buf, "%d\n", (int)mode);
  605. }
  606. static DEVICE_ATTR(product_id, S_IRUGO, elan_sysfs_read_product_id, NULL);
  607. static DEVICE_ATTR(firmware_version, S_IRUGO, elan_sysfs_read_fw_ver, NULL);
  608. static DEVICE_ATTR(sample_version, S_IRUGO, elan_sysfs_read_sm_ver, NULL);
  609. static DEVICE_ATTR(iap_version, S_IRUGO, elan_sysfs_read_iap_ver, NULL);
  610. static DEVICE_ATTR(fw_checksum, S_IRUGO, elan_sysfs_read_fw_checksum, NULL);
  611. static DEVICE_ATTR(mode, S_IRUGO, elan_sysfs_read_mode, NULL);
  612. static DEVICE_ATTR(update_fw, S_IWUSR, NULL, elan_sysfs_update_fw);
  613. static DEVICE_ATTR_WO(calibrate);
  614. static struct attribute *elan_sysfs_entries[] = {
  615. &dev_attr_product_id.attr,
  616. &dev_attr_firmware_version.attr,
  617. &dev_attr_sample_version.attr,
  618. &dev_attr_iap_version.attr,
  619. &dev_attr_fw_checksum.attr,
  620. &dev_attr_calibrate.attr,
  621. &dev_attr_mode.attr,
  622. &dev_attr_update_fw.attr,
  623. NULL,
  624. };
  625. static const struct attribute_group elan_sysfs_group = {
  626. .attrs = elan_sysfs_entries,
  627. };
  628. static ssize_t acquire_store(struct device *dev, struct device_attribute *attr,
  629. const char *buf, size_t count)
  630. {
  631. struct i2c_client *client = to_i2c_client(dev);
  632. struct elan_tp_data *data = i2c_get_clientdata(client);
  633. int error;
  634. int retval;
  635. retval = mutex_lock_interruptible(&data->sysfs_mutex);
  636. if (retval)
  637. return retval;
  638. disable_irq(client->irq);
  639. data->baseline_ready = false;
  640. data->mode |= ETP_ENABLE_CALIBRATE;
  641. retval = data->ops->set_mode(data->client, data->mode);
  642. if (retval) {
  643. dev_err(dev, "Failed to enable calibration mode to get baseline: %d\n",
  644. retval);
  645. goto out;
  646. }
  647. msleep(250);
  648. retval = data->ops->get_baseline_data(data->client, true,
  649. &data->max_baseline);
  650. if (retval) {
  651. dev_err(dev, "Failed to read max baseline form device: %d\n",
  652. retval);
  653. goto out_disable_calibrate;
  654. }
  655. retval = data->ops->get_baseline_data(data->client, false,
  656. &data->min_baseline);
  657. if (retval) {
  658. dev_err(dev, "Failed to read min baseline form device: %d\n",
  659. retval);
  660. goto out_disable_calibrate;
  661. }
  662. data->baseline_ready = true;
  663. out_disable_calibrate:
  664. data->mode &= ~ETP_ENABLE_CALIBRATE;
  665. error = data->ops->set_mode(data->client, data->mode);
  666. if (error) {
  667. dev_err(dev, "Failed to disable calibration mode after acquiring baseline: %d\n",
  668. error);
  669. if (!retval)
  670. retval = error;
  671. }
  672. out:
  673. enable_irq(client->irq);
  674. mutex_unlock(&data->sysfs_mutex);
  675. return retval ?: count;
  676. }
  677. static ssize_t min_show(struct device *dev,
  678. struct device_attribute *attr, char *buf)
  679. {
  680. struct i2c_client *client = to_i2c_client(dev);
  681. struct elan_tp_data *data = i2c_get_clientdata(client);
  682. int retval;
  683. retval = mutex_lock_interruptible(&data->sysfs_mutex);
  684. if (retval)
  685. return retval;
  686. if (!data->baseline_ready) {
  687. retval = -ENODATA;
  688. goto out;
  689. }
  690. retval = snprintf(buf, PAGE_SIZE, "%d", data->min_baseline);
  691. out:
  692. mutex_unlock(&data->sysfs_mutex);
  693. return retval;
  694. }
  695. static ssize_t max_show(struct device *dev,
  696. struct device_attribute *attr, char *buf)
  697. {
  698. struct i2c_client *client = to_i2c_client(dev);
  699. struct elan_tp_data *data = i2c_get_clientdata(client);
  700. int retval;
  701. retval = mutex_lock_interruptible(&data->sysfs_mutex);
  702. if (retval)
  703. return retval;
  704. if (!data->baseline_ready) {
  705. retval = -ENODATA;
  706. goto out;
  707. }
  708. retval = snprintf(buf, PAGE_SIZE, "%d", data->max_baseline);
  709. out:
  710. mutex_unlock(&data->sysfs_mutex);
  711. return retval;
  712. }
  713. static DEVICE_ATTR_WO(acquire);
  714. static DEVICE_ATTR_RO(min);
  715. static DEVICE_ATTR_RO(max);
  716. static struct attribute *elan_baseline_sysfs_entries[] = {
  717. &dev_attr_acquire.attr,
  718. &dev_attr_min.attr,
  719. &dev_attr_max.attr,
  720. NULL,
  721. };
  722. static const struct attribute_group elan_baseline_sysfs_group = {
  723. .name = "baseline",
  724. .attrs = elan_baseline_sysfs_entries,
  725. };
  726. static const struct attribute_group *elan_sysfs_groups[] = {
  727. &elan_sysfs_group,
  728. &elan_baseline_sysfs_group,
  729. NULL
  730. };
  731. /*
  732. ******************************************************************
  733. * Elan isr functions
  734. ******************************************************************
  735. */
  736. static void elan_report_contact(struct elan_tp_data *data, int contact_num,
  737. bool contact_valid, bool high_precision,
  738. u8 *packet, u8 *finger_data)
  739. {
  740. struct input_dev *input = data->input;
  741. unsigned int pos_x, pos_y;
  742. unsigned int pressure, scaled_pressure;
  743. if (contact_valid) {
  744. if (high_precision) {
  745. pos_x = get_unaligned_be16(&finger_data[0]);
  746. pos_y = get_unaligned_be16(&finger_data[2]);
  747. } else {
  748. pos_x = ((finger_data[0] & 0xf0) << 4) | finger_data[1];
  749. pos_y = ((finger_data[0] & 0x0f) << 8) | finger_data[2];
  750. }
  751. if (pos_x > data->max_x || pos_y > data->max_y) {
  752. dev_dbg(input->dev.parent,
  753. "[%d] x=%d y=%d over max (%d, %d)",
  754. contact_num, pos_x, pos_y,
  755. data->max_x, data->max_y);
  756. return;
  757. }
  758. pressure = finger_data[4];
  759. scaled_pressure = pressure + data->pressure_adjustment;
  760. if (scaled_pressure > ETP_MAX_PRESSURE)
  761. scaled_pressure = ETP_MAX_PRESSURE;
  762. input_mt_slot(input, contact_num);
  763. input_mt_report_slot_state(input, MT_TOOL_FINGER, true);
  764. input_report_abs(input, ABS_MT_POSITION_X, pos_x);
  765. input_report_abs(input, ABS_MT_POSITION_Y, data->max_y - pos_y);
  766. input_report_abs(input, ABS_MT_PRESSURE, scaled_pressure);
  767. if (data->report_features & ETP_FEATURE_REPORT_MK) {
  768. unsigned int mk_x, mk_y, area_x, area_y;
  769. u8 mk_data = high_precision ?
  770. packet[ETP_MK_DATA_OFFSET + contact_num] :
  771. finger_data[3];
  772. mk_x = mk_data & 0x0f;
  773. mk_y = mk_data >> 4;
  774. /*
  775. * To avoid treating large finger as palm, let's reduce
  776. * the width x and y per trace.
  777. */
  778. area_x = mk_x * (data->width_x - ETP_FWIDTH_REDUCE);
  779. area_y = mk_y * (data->width_y - ETP_FWIDTH_REDUCE);
  780. input_report_abs(input, ABS_TOOL_WIDTH, mk_x);
  781. input_report_abs(input, ABS_MT_TOUCH_MAJOR,
  782. max(area_x, area_y));
  783. input_report_abs(input, ABS_MT_TOUCH_MINOR,
  784. min(area_x, area_y));
  785. }
  786. } else {
  787. input_mt_slot(input, contact_num);
  788. input_mt_report_slot_inactive(input);
  789. }
  790. }
  791. static void elan_report_absolute(struct elan_tp_data *data, u8 *packet,
  792. bool high_precision)
  793. {
  794. struct input_dev *input = data->input;
  795. u8 *finger_data = &packet[ETP_FINGER_DATA_OFFSET];
  796. int i;
  797. u8 tp_info = packet[ETP_TOUCH_INFO_OFFSET];
  798. u8 hover_info = packet[ETP_HOVER_INFO_OFFSET];
  799. bool contact_valid, hover_event;
  800. pm_wakeup_event(&data->client->dev, 0);
  801. hover_event = hover_info & BIT(6);
  802. for (i = 0; i < ETP_MAX_FINGERS; i++) {
  803. contact_valid = tp_info & BIT(3 + i);
  804. elan_report_contact(data, i, contact_valid, high_precision,
  805. packet, finger_data);
  806. if (contact_valid)
  807. finger_data += ETP_FINGER_DATA_LEN;
  808. }
  809. input_report_key(input, BTN_LEFT, tp_info & BIT(0));
  810. input_report_key(input, BTN_MIDDLE, tp_info & BIT(2));
  811. input_report_key(input, BTN_RIGHT, tp_info & BIT(1));
  812. input_report_abs(input, ABS_DISTANCE, hover_event != 0);
  813. input_mt_report_pointer_emulation(input, true);
  814. input_sync(input);
  815. }
  816. static void elan_report_trackpoint(struct elan_tp_data *data, u8 *report)
  817. {
  818. struct input_dev *input = data->tp_input;
  819. u8 *packet = &report[ETP_REPORT_ID_OFFSET + 1];
  820. int x, y;
  821. pm_wakeup_event(&data->client->dev, 0);
  822. if (!data->tp_input) {
  823. dev_warn_once(&data->client->dev,
  824. "received a trackpoint report while no trackpoint device has been created. Please report upstream.\n");
  825. return;
  826. }
  827. input_report_key(input, BTN_LEFT, packet[0] & 0x01);
  828. input_report_key(input, BTN_RIGHT, packet[0] & 0x02);
  829. input_report_key(input, BTN_MIDDLE, packet[0] & 0x04);
  830. if ((packet[3] & 0x0F) == 0x06) {
  831. x = packet[4] - (int)((packet[1] ^ 0x80) << 1);
  832. y = (int)((packet[2] ^ 0x80) << 1) - packet[5];
  833. input_report_rel(input, REL_X, x);
  834. input_report_rel(input, REL_Y, y);
  835. }
  836. input_sync(input);
  837. }
  838. static irqreturn_t elan_isr(int irq, void *dev_id)
  839. {
  840. struct elan_tp_data *data = dev_id;
  841. int error;
  842. u8 report[ETP_MAX_REPORT_LEN];
  843. /*
  844. * When device is connected to i2c bus, when all IAP page writes
  845. * complete, the driver will receive interrupt and must read
  846. * 0000 to confirm that IAP is finished.
  847. */
  848. if (data->in_fw_update) {
  849. complete(&data->fw_completion);
  850. goto out;
  851. }
  852. error = data->ops->get_report(data->client, report, data->report_len);
  853. if (error)
  854. goto out;
  855. switch (report[ETP_REPORT_ID_OFFSET]) {
  856. case ETP_REPORT_ID:
  857. elan_report_absolute(data, report, false);
  858. break;
  859. case ETP_REPORT_ID2:
  860. elan_report_absolute(data, report, true);
  861. break;
  862. case ETP_TP_REPORT_ID:
  863. case ETP_TP_REPORT_ID2:
  864. elan_report_trackpoint(data, report);
  865. break;
  866. default:
  867. dev_err(&data->client->dev, "invalid report id data (%x)\n",
  868. report[ETP_REPORT_ID_OFFSET]);
  869. }
  870. out:
  871. return IRQ_HANDLED;
  872. }
  873. /*
  874. ******************************************************************
  875. * Elan initialization functions
  876. ******************************************************************
  877. */
  878. static int elan_setup_trackpoint_input_device(struct elan_tp_data *data)
  879. {
  880. struct device *dev = &data->client->dev;
  881. struct input_dev *input;
  882. input = devm_input_allocate_device(dev);
  883. if (!input)
  884. return -ENOMEM;
  885. input->name = "Elan TrackPoint";
  886. input->id.bustype = BUS_I2C;
  887. input->id.vendor = ELAN_VENDOR_ID;
  888. input->id.product = data->product_id;
  889. input_set_drvdata(input, data);
  890. input_set_capability(input, EV_REL, REL_X);
  891. input_set_capability(input, EV_REL, REL_Y);
  892. input_set_capability(input, EV_KEY, BTN_LEFT);
  893. input_set_capability(input, EV_KEY, BTN_RIGHT);
  894. input_set_capability(input, EV_KEY, BTN_MIDDLE);
  895. __set_bit(INPUT_PROP_POINTER, input->propbit);
  896. __set_bit(INPUT_PROP_POINTING_STICK, input->propbit);
  897. data->tp_input = input;
  898. return 0;
  899. }
  900. static int elan_setup_input_device(struct elan_tp_data *data)
  901. {
  902. struct device *dev = &data->client->dev;
  903. struct input_dev *input;
  904. unsigned int max_width = max(data->width_x, data->width_y);
  905. unsigned int min_width = min(data->width_x, data->width_y);
  906. int error;
  907. input = devm_input_allocate_device(dev);
  908. if (!input)
  909. return -ENOMEM;
  910. input->name = "Elan Touchpad";
  911. input->id.bustype = BUS_I2C;
  912. input->id.vendor = ELAN_VENDOR_ID;
  913. input->id.product = data->product_id;
  914. input_set_drvdata(input, data);
  915. error = input_mt_init_slots(input, ETP_MAX_FINGERS,
  916. INPUT_MT_POINTER | INPUT_MT_DROP_UNUSED);
  917. if (error) {
  918. dev_err(dev, "failed to initialize MT slots: %d\n", error);
  919. return error;
  920. }
  921. __set_bit(EV_ABS, input->evbit);
  922. __set_bit(INPUT_PROP_POINTER, input->propbit);
  923. if (data->clickpad) {
  924. __set_bit(INPUT_PROP_BUTTONPAD, input->propbit);
  925. } else {
  926. __set_bit(BTN_RIGHT, input->keybit);
  927. if (data->middle_button)
  928. __set_bit(BTN_MIDDLE, input->keybit);
  929. }
  930. __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. if (data->report_features & ETP_FEATURE_REPORT_MK)
  938. input_set_abs_params(input, ABS_TOOL_WIDTH,
  939. 0, ETP_FINGER_WIDTH, 0, 0);
  940. input_set_abs_params(input, ABS_DISTANCE, 0, 1, 0, 0);
  941. /* And MT parameters */
  942. input_set_abs_params(input, ABS_MT_POSITION_X, 0, data->max_x, 0, 0);
  943. input_set_abs_params(input, ABS_MT_POSITION_Y, 0, data->max_y, 0, 0);
  944. input_abs_set_res(input, ABS_MT_POSITION_X, data->x_res);
  945. input_abs_set_res(input, ABS_MT_POSITION_Y, data->y_res);
  946. input_set_abs_params(input, ABS_MT_PRESSURE, 0,
  947. ETP_MAX_PRESSURE, 0, 0);
  948. if (data->report_features & ETP_FEATURE_REPORT_MK) {
  949. input_set_abs_params(input, ABS_MT_TOUCH_MAJOR,
  950. 0, ETP_FINGER_WIDTH * max_width, 0, 0);
  951. input_set_abs_params(input, ABS_MT_TOUCH_MINOR,
  952. 0, ETP_FINGER_WIDTH * min_width, 0, 0);
  953. }
  954. data->input = input;
  955. return 0;
  956. }
  957. static void elan_disable_regulator(void *_data)
  958. {
  959. struct elan_tp_data *data = _data;
  960. regulator_disable(data->vcc);
  961. }
  962. static int elan_probe(struct i2c_client *client,
  963. const struct i2c_device_id *dev_id)
  964. {
  965. const struct elan_transport_ops *transport_ops;
  966. struct device *dev = &client->dev;
  967. struct elan_tp_data *data;
  968. unsigned long irqflags;
  969. int error;
  970. if (IS_ENABLED(CONFIG_MOUSE_ELAN_I2C_I2C) &&
  971. i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
  972. transport_ops = &elan_i2c_ops;
  973. } else if (IS_ENABLED(CONFIG_MOUSE_ELAN_I2C_SMBUS) &&
  974. i2c_check_functionality(client->adapter,
  975. I2C_FUNC_SMBUS_BYTE_DATA |
  976. I2C_FUNC_SMBUS_BLOCK_DATA |
  977. I2C_FUNC_SMBUS_I2C_BLOCK)) {
  978. transport_ops = &elan_smbus_ops;
  979. } else {
  980. dev_err(dev, "not a supported I2C/SMBus adapter\n");
  981. return -EIO;
  982. }
  983. data = devm_kzalloc(dev, sizeof(struct elan_tp_data), GFP_KERNEL);
  984. if (!data)
  985. return -ENOMEM;
  986. i2c_set_clientdata(client, data);
  987. data->ops = transport_ops;
  988. data->client = client;
  989. init_completion(&data->fw_completion);
  990. mutex_init(&data->sysfs_mutex);
  991. data->vcc = devm_regulator_get(dev, "vcc");
  992. if (IS_ERR(data->vcc)) {
  993. error = PTR_ERR(data->vcc);
  994. if (error != -EPROBE_DEFER)
  995. dev_err(dev, "Failed to get 'vcc' regulator: %d\n",
  996. error);
  997. return error;
  998. }
  999. error = regulator_enable(data->vcc);
  1000. if (error) {
  1001. dev_err(dev, "Failed to enable regulator: %d\n", error);
  1002. return error;
  1003. }
  1004. error = devm_add_action_or_reset(dev, elan_disable_regulator, data);
  1005. if (error) {
  1006. dev_err(dev, "Failed to add disable regulator action: %d\n",
  1007. error);
  1008. return error;
  1009. }
  1010. /* Make sure there is something at this address */
  1011. error = i2c_smbus_read_byte(client);
  1012. if (error < 0) {
  1013. dev_dbg(&client->dev, "nothing at this address: %d\n", error);
  1014. return -ENXIO;
  1015. }
  1016. /* Initialize the touchpad. */
  1017. error = elan_initialize(data);
  1018. if (error)
  1019. return error;
  1020. error = elan_query_device_info(data);
  1021. if (error)
  1022. return error;
  1023. error = elan_query_device_parameters(data);
  1024. if (error)
  1025. return error;
  1026. dev_info(dev,
  1027. "Elan Touchpad: Module ID: 0x%04x, Firmware: 0x%04x, Sample: 0x%04x, IAP: 0x%04x\n",
  1028. data->product_id,
  1029. data->fw_version,
  1030. data->sm_version,
  1031. data->iap_version);
  1032. dev_dbg(dev,
  1033. "Elan Touchpad Extra Information:\n"
  1034. " Max ABS X,Y: %d,%d\n"
  1035. " Width X,Y: %d,%d\n"
  1036. " Resolution X,Y: %d,%d (dots/mm)\n"
  1037. " ic type: 0x%x\n"
  1038. " info pattern: 0x%x\n",
  1039. data->max_x, data->max_y,
  1040. data->width_x, data->width_y,
  1041. data->x_res, data->y_res,
  1042. data->ic_type, data->pattern);
  1043. /* Set up input device properties based on queried parameters. */
  1044. error = elan_setup_input_device(data);
  1045. if (error)
  1046. return error;
  1047. if (device_property_read_bool(&client->dev, "elan,trackpoint")) {
  1048. error = elan_setup_trackpoint_input_device(data);
  1049. if (error)
  1050. return error;
  1051. }
  1052. /*
  1053. * Platform code (ACPI, DTS) should normally set up interrupt
  1054. * for us, but in case it did not let's fall back to using falling
  1055. * edge to be compatible with older Chromebooks.
  1056. */
  1057. irqflags = irq_get_trigger_type(client->irq);
  1058. if (!irqflags)
  1059. irqflags = IRQF_TRIGGER_FALLING;
  1060. error = devm_request_threaded_irq(dev, client->irq, NULL, elan_isr,
  1061. irqflags | IRQF_ONESHOT,
  1062. client->name, data);
  1063. if (error) {
  1064. dev_err(dev, "cannot register irq=%d\n", client->irq);
  1065. return error;
  1066. }
  1067. error = devm_device_add_groups(dev, elan_sysfs_groups);
  1068. if (error) {
  1069. dev_err(dev, "failed to create sysfs attributes: %d\n", error);
  1070. return error;
  1071. }
  1072. error = input_register_device(data->input);
  1073. if (error) {
  1074. dev_err(dev, "failed to register input device: %d\n", error);
  1075. return error;
  1076. }
  1077. if (data->tp_input) {
  1078. error = input_register_device(data->tp_input);
  1079. if (error) {
  1080. dev_err(&client->dev,
  1081. "failed to register TrackPoint input device: %d\n",
  1082. error);
  1083. return error;
  1084. }
  1085. }
  1086. /*
  1087. * Systems using device tree should set up wakeup via DTS,
  1088. * the rest will configure device as wakeup source by default.
  1089. */
  1090. if (!dev->of_node)
  1091. device_init_wakeup(dev, true);
  1092. return 0;
  1093. }
  1094. static int __maybe_unused elan_suspend(struct device *dev)
  1095. {
  1096. struct i2c_client *client = to_i2c_client(dev);
  1097. struct elan_tp_data *data = i2c_get_clientdata(client);
  1098. int ret;
  1099. /*
  1100. * We are taking the mutex to make sure sysfs operations are
  1101. * complete before we attempt to bring the device into low[er]
  1102. * power mode.
  1103. */
  1104. ret = mutex_lock_interruptible(&data->sysfs_mutex);
  1105. if (ret)
  1106. return ret;
  1107. disable_irq(client->irq);
  1108. if (device_may_wakeup(dev)) {
  1109. ret = elan_sleep(data);
  1110. /* Enable wake from IRQ */
  1111. data->irq_wake = (enable_irq_wake(client->irq) == 0);
  1112. } else {
  1113. ret = elan_set_power(data, false);
  1114. if (ret)
  1115. goto err;
  1116. ret = regulator_disable(data->vcc);
  1117. if (ret) {
  1118. dev_err(dev, "error %d disabling regulator\n", ret);
  1119. /* Attempt to power the chip back up */
  1120. elan_set_power(data, true);
  1121. }
  1122. }
  1123. err:
  1124. mutex_unlock(&data->sysfs_mutex);
  1125. return ret;
  1126. }
  1127. static int __maybe_unused elan_resume(struct device *dev)
  1128. {
  1129. struct i2c_client *client = to_i2c_client(dev);
  1130. struct elan_tp_data *data = i2c_get_clientdata(client);
  1131. int error;
  1132. if (!device_may_wakeup(dev)) {
  1133. error = regulator_enable(data->vcc);
  1134. if (error) {
  1135. dev_err(dev, "error %d enabling regulator\n", error);
  1136. goto err;
  1137. }
  1138. } else if (data->irq_wake) {
  1139. disable_irq_wake(client->irq);
  1140. data->irq_wake = false;
  1141. }
  1142. error = elan_set_power(data, true);
  1143. if (error) {
  1144. dev_err(dev, "power up when resuming failed: %d\n", error);
  1145. goto err;
  1146. }
  1147. error = elan_initialize(data);
  1148. if (error)
  1149. dev_err(dev, "initialize when resuming failed: %d\n", error);
  1150. err:
  1151. enable_irq(data->client->irq);
  1152. return error;
  1153. }
  1154. static SIMPLE_DEV_PM_OPS(elan_pm_ops, elan_suspend, elan_resume);
  1155. static const struct i2c_device_id elan_id[] = {
  1156. { DRIVER_NAME, 0 },
  1157. { },
  1158. };
  1159. MODULE_DEVICE_TABLE(i2c, elan_id);
  1160. #ifdef CONFIG_ACPI
  1161. MODULE_DEVICE_TABLE(acpi, elan_acpi_id);
  1162. #endif
  1163. #ifdef CONFIG_OF
  1164. static const struct of_device_id elan_of_match[] = {
  1165. { .compatible = "elan,ekth3000" },
  1166. { /* sentinel */ }
  1167. };
  1168. MODULE_DEVICE_TABLE(of, elan_of_match);
  1169. #endif
  1170. static struct i2c_driver elan_driver = {
  1171. .driver = {
  1172. .name = DRIVER_NAME,
  1173. .pm = &elan_pm_ops,
  1174. .acpi_match_table = ACPI_PTR(elan_acpi_id),
  1175. .of_match_table = of_match_ptr(elan_of_match),
  1176. .probe_type = PROBE_PREFER_ASYNCHRONOUS,
  1177. },
  1178. .probe = elan_probe,
  1179. .id_table = elan_id,
  1180. };
  1181. module_i2c_driver(elan_driver);
  1182. MODULE_AUTHOR("Duson Lin <dusonlin@emc.com.tw>");
  1183. MODULE_DESCRIPTION("Elan I2C/SMBus Touchpad driver");
  1184. MODULE_LICENSE("GPL");