1 // SPDX-License-Identifier: GPL-2.0 2 // STMicroelectronics FTS Touchscreen device driver 3 // 4 // Copyright (c) 2017 Samsung Electronics Co., Ltd. 5 // Copyright (c) 2017 Andi Shyti <andi@etezian.org> 6 7 #include <linux/delay.h> 8 #include <linux/i2c.h> 9 #include <linux/input/mt.h> 10 #include <linux/input/touchscreen.h> 11 #include <linux/interrupt.h> 12 #include <linux/irq.h> 13 #include <linux/leds.h> 14 #include <linux/module.h> 15 #include <linux/pm_runtime.h> 16 #include <linux/regulator/consumer.h> 17 18 /* I2C commands */ 19 #define STMFTS_READ_INFO 0x80 20 #define STMFTS_READ_STATUS 0x84 21 #define STMFTS_READ_ONE_EVENT 0x85 22 #define STMFTS_READ_ALL_EVENT 0x86 23 #define STMFTS_LATEST_EVENT 0x87 24 #define STMFTS_SLEEP_IN 0x90 25 #define STMFTS_SLEEP_OUT 0x91 26 #define STMFTS_MS_MT_SENSE_OFF 0x92 27 #define STMFTS_MS_MT_SENSE_ON 0x93 28 #define STMFTS_SS_HOVER_SENSE_OFF 0x94 29 #define STMFTS_SS_HOVER_SENSE_ON 0x95 30 #define STMFTS_MS_KEY_SENSE_OFF 0x9a 31 #define STMFTS_MS_KEY_SENSE_ON 0x9b 32 #define STMFTS_SYSTEM_RESET 0xa0 33 #define STMFTS_CLEAR_EVENT_STACK 0xa1 34 #define STMFTS_FULL_FORCE_CALIBRATION 0xa2 35 #define STMFTS_MS_CX_TUNING 0xa3 36 #define STMFTS_SS_CX_TUNING 0xa4 37 38 /* events */ 39 #define STMFTS_EV_NO_EVENT 0x00 40 #define STMFTS_EV_MULTI_TOUCH_DETECTED 0x02 41 #define STMFTS_EV_MULTI_TOUCH_ENTER 0x03 42 #define STMFTS_EV_MULTI_TOUCH_LEAVE 0x04 43 #define STMFTS_EV_MULTI_TOUCH_MOTION 0x05 44 #define STMFTS_EV_HOVER_ENTER 0x07 45 #define STMFTS_EV_HOVER_LEAVE 0x08 46 #define STMFTS_EV_HOVER_MOTION 0x09 47 #define STMFTS_EV_KEY_STATUS 0x0e 48 #define STMFTS_EV_ERROR 0x0f 49 #define STMFTS_EV_CONTROLLER_READY 0x10 50 #define STMFTS_EV_SLEEP_OUT_CONTROLLER_READY 0x11 51 #define STMFTS_EV_STATUS 0x16 52 #define STMFTS_EV_DEBUG 0xdb 53 54 /* multi touch related event masks */ 55 #define STMFTS_MASK_EVENT_ID 0x0f 56 #define STMFTS_MASK_TOUCH_ID 0xf0 57 #define STMFTS_MASK_LEFT_EVENT 0x0f 58 #define STMFTS_MASK_X_MSB 0x0f 59 #define STMFTS_MASK_Y_LSB 0xf0 60 61 /* key related event masks */ 62 #define STMFTS_MASK_KEY_NO_TOUCH 0x00 63 #define STMFTS_MASK_KEY_MENU 0x01 64 #define STMFTS_MASK_KEY_BACK 0x02 65 66 #define STMFTS_EVENT_SIZE 8 67 #define STMFTS_STACK_DEPTH 32 68 #define STMFTS_DATA_MAX_SIZE (STMFTS_EVENT_SIZE * STMFTS_STACK_DEPTH) 69 #define STMFTS_MAX_FINGERS 10 70 #define STMFTS_DEV_NAME "stmfts" 71 72 enum stmfts_regulators { 73 STMFTS_REGULATOR_VDD, 74 STMFTS_REGULATOR_AVDD, 75 }; 76 77 struct stmfts_data { 78 struct i2c_client *client; 79 struct input_dev *input; 80 struct led_classdev led_cdev; 81 struct mutex mutex; 82 83 struct touchscreen_properties prop; 84 85 struct regulator_bulk_data regulators[2]; 86 87 /* 88 * Presence of ledvdd will be used also to check 89 * whether the LED is supported. 90 */ 91 struct regulator *ledvdd; 92 93 u16 chip_id; 94 u8 chip_ver; 95 u16 fw_ver; 96 u8 config_id; 97 u8 config_ver; 98 99 u8 data[STMFTS_DATA_MAX_SIZE]; 100 101 struct completion cmd_done; 102 103 bool use_key; 104 bool led_status; 105 bool hover_enabled; 106 bool running; 107 }; 108 109 static int stmfts_brightness_set(struct led_classdev *led_cdev, 110 enum led_brightness value) 111 { 112 struct stmfts_data *sdata = container_of(led_cdev, 113 struct stmfts_data, led_cdev); 114 int err; 115 116 if (value != sdata->led_status && sdata->ledvdd) { 117 if (!value) { 118 regulator_disable(sdata->ledvdd); 119 } else { 120 err = regulator_enable(sdata->ledvdd); 121 if (err) { 122 dev_warn(&sdata->client->dev, 123 "failed to disable ledvdd regulator: %d\n", 124 err); 125 return err; 126 } 127 } 128 sdata->led_status = value; 129 } 130 131 return 0; 132 } 133 134 static enum led_brightness stmfts_brightness_get(struct led_classdev *led_cdev) 135 { 136 struct stmfts_data *sdata = container_of(led_cdev, 137 struct stmfts_data, led_cdev); 138 139 return !!regulator_is_enabled(sdata->ledvdd); 140 } 141 142 /* 143 * We can't simply use i2c_smbus_read_i2c_block_data because we 144 * need to read more than 255 bytes ( 145 */ 146 static int stmfts_read_events(struct stmfts_data *sdata) 147 { 148 u8 cmd = STMFTS_READ_ALL_EVENT; 149 struct i2c_msg msgs[2] = { 150 { 151 .addr = sdata->client->addr, 152 .len = 1, 153 .buf = &cmd, 154 }, 155 { 156 .addr = sdata->client->addr, 157 .flags = I2C_M_RD, 158 .len = STMFTS_DATA_MAX_SIZE, 159 .buf = sdata->data, 160 }, 161 }; 162 int ret; 163 164 ret = i2c_transfer(sdata->client->adapter, msgs, ARRAY_SIZE(msgs)); 165 if (ret < 0) 166 return ret; 167 168 return ret == ARRAY_SIZE(msgs) ? 0 : -EIO; 169 } 170 171 static void stmfts_report_contact_event(struct stmfts_data *sdata, 172 const u8 event[]) 173 { 174 u8 slot_id = (event[0] & STMFTS_MASK_TOUCH_ID) >> 4; 175 u16 x = event[1] | ((event[2] & STMFTS_MASK_X_MSB) << 8); 176 u16 y = (event[2] >> 4) | (event[3] << 4); 177 u8 maj = event[4]; 178 u8 min = event[5]; 179 u8 orientation = event[6]; 180 u8 area = event[7]; 181 182 input_mt_slot(sdata->input, slot_id); 183 184 input_mt_report_slot_state(sdata->input, MT_TOOL_FINGER, true); 185 input_report_abs(sdata->input, ABS_MT_POSITION_X, x); 186 input_report_abs(sdata->input, ABS_MT_POSITION_Y, y); 187 input_report_abs(sdata->input, ABS_MT_TOUCH_MAJOR, maj); 188 input_report_abs(sdata->input, ABS_MT_TOUCH_MINOR, min); 189 input_report_abs(sdata->input, ABS_MT_PRESSURE, area); 190 input_report_abs(sdata->input, ABS_MT_ORIENTATION, orientation); 191 192 input_sync(sdata->input); 193 } 194 195 static void stmfts_report_contact_release(struct stmfts_data *sdata, 196 const u8 event[]) 197 { 198 u8 slot_id = (event[0] & STMFTS_MASK_TOUCH_ID) >> 4; 199 200 input_mt_slot(sdata->input, slot_id); 201 input_mt_report_slot_inactive(sdata->input); 202 203 input_sync(sdata->input); 204 } 205 206 static void stmfts_report_hover_event(struct stmfts_data *sdata, 207 const u8 event[]) 208 { 209 u16 x = (event[2] << 4) | (event[4] >> 4); 210 u16 y = (event[3] << 4) | (event[4] & STMFTS_MASK_Y_LSB); 211 u8 z = event[5]; 212 213 input_report_abs(sdata->input, ABS_X, x); 214 input_report_abs(sdata->input, ABS_Y, y); 215 input_report_abs(sdata->input, ABS_DISTANCE, z); 216 217 input_sync(sdata->input); 218 } 219 220 static void stmfts_report_key_event(struct stmfts_data *sdata, const u8 event[]) 221 { 222 switch (event[2]) { 223 case 0: 224 input_report_key(sdata->input, KEY_BACK, 0); 225 input_report_key(sdata->input, KEY_MENU, 0); 226 break; 227 228 case STMFTS_MASK_KEY_BACK: 229 input_report_key(sdata->input, KEY_BACK, 1); 230 break; 231 232 case STMFTS_MASK_KEY_MENU: 233 input_report_key(sdata->input, KEY_MENU, 1); 234 break; 235 236 default: 237 dev_warn(&sdata->client->dev, 238 "unknown key event: %#02x\n", event[2]); 239 break; 240 } 241 242 input_sync(sdata->input); 243 } 244 245 static void stmfts_parse_events(struct stmfts_data *sdata) 246 { 247 int i; 248 249 for (i = 0; i < STMFTS_STACK_DEPTH; i++) { 250 u8 *event = &sdata->data[i * STMFTS_EVENT_SIZE]; 251 252 switch (event[0]) { 253 254 case STMFTS_EV_CONTROLLER_READY: 255 case STMFTS_EV_SLEEP_OUT_CONTROLLER_READY: 256 case STMFTS_EV_STATUS: 257 complete(&sdata->cmd_done); 258 fallthrough; 259 260 case STMFTS_EV_NO_EVENT: 261 case STMFTS_EV_DEBUG: 262 return; 263 } 264 265 switch (event[0] & STMFTS_MASK_EVENT_ID) { 266 267 case STMFTS_EV_MULTI_TOUCH_ENTER: 268 case STMFTS_EV_MULTI_TOUCH_MOTION: 269 stmfts_report_contact_event(sdata, event); 270 break; 271 272 case STMFTS_EV_MULTI_TOUCH_LEAVE: 273 stmfts_report_contact_release(sdata, event); 274 break; 275 276 case STMFTS_EV_HOVER_ENTER: 277 case STMFTS_EV_HOVER_LEAVE: 278 case STMFTS_EV_HOVER_MOTION: 279 stmfts_report_hover_event(sdata, event); 280 break; 281 282 case STMFTS_EV_KEY_STATUS: 283 stmfts_report_key_event(sdata, event); 284 break; 285 286 case STMFTS_EV_ERROR: 287 dev_warn(&sdata->client->dev, 288 "error code: 0x%x%x%x%x%x%x", 289 event[6], event[5], event[4], 290 event[3], event[2], event[1]); 291 break; 292 293 default: 294 dev_err(&sdata->client->dev, 295 "unknown event %#02x\n", event[0]); 296 } 297 } 298 } 299 300 static irqreturn_t stmfts_irq_handler(int irq, void *dev) 301 { 302 struct stmfts_data *sdata = dev; 303 int err; 304 305 mutex_lock(&sdata->mutex); 306 307 err = stmfts_read_events(sdata); 308 if (unlikely(err)) 309 dev_err(&sdata->client->dev, 310 "failed to read events: %d\n", err); 311 else 312 stmfts_parse_events(sdata); 313 314 mutex_unlock(&sdata->mutex); 315 return IRQ_HANDLED; 316 } 317 318 static int stmfts_command(struct stmfts_data *sdata, const u8 cmd) 319 { 320 int err; 321 322 reinit_completion(&sdata->cmd_done); 323 324 err = i2c_smbus_write_byte(sdata->client, cmd); 325 if (err) 326 return err; 327 328 if (!wait_for_completion_timeout(&sdata->cmd_done, 329 msecs_to_jiffies(1000))) 330 return -ETIMEDOUT; 331 332 return 0; 333 } 334 335 static int stmfts_input_open(struct input_dev *dev) 336 { 337 struct stmfts_data *sdata = input_get_drvdata(dev); 338 int err; 339 340 err = pm_runtime_get_sync(&sdata->client->dev); 341 if (err < 0) 342 return err; 343 344 err = i2c_smbus_write_byte(sdata->client, STMFTS_MS_MT_SENSE_ON); 345 if (err) 346 return err; 347 348 mutex_lock(&sdata->mutex); 349 sdata->running = true; 350 351 if (sdata->hover_enabled) { 352 err = i2c_smbus_write_byte(sdata->client, 353 STMFTS_SS_HOVER_SENSE_ON); 354 if (err) 355 dev_warn(&sdata->client->dev, 356 "failed to enable hover\n"); 357 } 358 mutex_unlock(&sdata->mutex); 359 360 if (sdata->use_key) { 361 err = i2c_smbus_write_byte(sdata->client, 362 STMFTS_MS_KEY_SENSE_ON); 363 if (err) 364 /* I can still use only the touch screen */ 365 dev_warn(&sdata->client->dev, 366 "failed to enable touchkey\n"); 367 } 368 369 return 0; 370 } 371 372 static void stmfts_input_close(struct input_dev *dev) 373 { 374 struct stmfts_data *sdata = input_get_drvdata(dev); 375 int err; 376 377 err = i2c_smbus_write_byte(sdata->client, STMFTS_MS_MT_SENSE_OFF); 378 if (err) 379 dev_warn(&sdata->client->dev, 380 "failed to disable touchscreen: %d\n", err); 381 382 mutex_lock(&sdata->mutex); 383 384 sdata->running = false; 385 386 if (sdata->hover_enabled) { 387 err = i2c_smbus_write_byte(sdata->client, 388 STMFTS_SS_HOVER_SENSE_OFF); 389 if (err) 390 dev_warn(&sdata->client->dev, 391 "failed to disable hover: %d\n", err); 392 } 393 mutex_unlock(&sdata->mutex); 394 395 if (sdata->use_key) { 396 err = i2c_smbus_write_byte(sdata->client, 397 STMFTS_MS_KEY_SENSE_OFF); 398 if (err) 399 dev_warn(&sdata->client->dev, 400 "failed to disable touchkey: %d\n", err); 401 } 402 403 pm_runtime_put_sync(&sdata->client->dev); 404 } 405 406 static ssize_t stmfts_sysfs_chip_id(struct device *dev, 407 struct device_attribute *attr, char *buf) 408 { 409 struct stmfts_data *sdata = dev_get_drvdata(dev); 410 411 return sprintf(buf, "%#x\n", sdata->chip_id); 412 } 413 414 static ssize_t stmfts_sysfs_chip_version(struct device *dev, 415 struct device_attribute *attr, char *buf) 416 { 417 struct stmfts_data *sdata = dev_get_drvdata(dev); 418 419 return sprintf(buf, "%u\n", sdata->chip_ver); 420 } 421 422 static ssize_t stmfts_sysfs_fw_ver(struct device *dev, 423 struct device_attribute *attr, char *buf) 424 { 425 struct stmfts_data *sdata = dev_get_drvdata(dev); 426 427 return sprintf(buf, "%u\n", sdata->fw_ver); 428 } 429 430 static ssize_t stmfts_sysfs_config_id(struct device *dev, 431 struct device_attribute *attr, char *buf) 432 { 433 struct stmfts_data *sdata = dev_get_drvdata(dev); 434 435 return sprintf(buf, "%#x\n", sdata->config_id); 436 } 437 438 static ssize_t stmfts_sysfs_config_version(struct device *dev, 439 struct device_attribute *attr, char *buf) 440 { 441 struct stmfts_data *sdata = dev_get_drvdata(dev); 442 443 return sprintf(buf, "%u\n", sdata->config_ver); 444 } 445 446 static ssize_t stmfts_sysfs_read_status(struct device *dev, 447 struct device_attribute *attr, char *buf) 448 { 449 struct stmfts_data *sdata = dev_get_drvdata(dev); 450 u8 status[4]; 451 int err; 452 453 err = i2c_smbus_read_i2c_block_data(sdata->client, STMFTS_READ_STATUS, 454 sizeof(status), status); 455 if (err) 456 return err; 457 458 return sprintf(buf, "%#02x\n", status[0]); 459 } 460 461 static ssize_t stmfts_sysfs_hover_enable_read(struct device *dev, 462 struct device_attribute *attr, char *buf) 463 { 464 struct stmfts_data *sdata = dev_get_drvdata(dev); 465 466 return sprintf(buf, "%u\n", sdata->hover_enabled); 467 } 468 469 static ssize_t stmfts_sysfs_hover_enable_write(struct device *dev, 470 struct device_attribute *attr, 471 const char *buf, size_t len) 472 { 473 struct stmfts_data *sdata = dev_get_drvdata(dev); 474 unsigned long value; 475 int err = 0; 476 477 if (kstrtoul(buf, 0, &value)) 478 return -EINVAL; 479 480 mutex_lock(&sdata->mutex); 481 482 if (value && sdata->hover_enabled) 483 goto out; 484 485 if (sdata->running) 486 err = i2c_smbus_write_byte(sdata->client, 487 value ? STMFTS_SS_HOVER_SENSE_ON : 488 STMFTS_SS_HOVER_SENSE_OFF); 489 490 if (!err) 491 sdata->hover_enabled = !!value; 492 493 out: 494 mutex_unlock(&sdata->mutex); 495 496 return len; 497 } 498 499 static DEVICE_ATTR(chip_id, 0444, stmfts_sysfs_chip_id, NULL); 500 static DEVICE_ATTR(chip_version, 0444, stmfts_sysfs_chip_version, NULL); 501 static DEVICE_ATTR(fw_ver, 0444, stmfts_sysfs_fw_ver, NULL); 502 static DEVICE_ATTR(config_id, 0444, stmfts_sysfs_config_id, NULL); 503 static DEVICE_ATTR(config_version, 0444, stmfts_sysfs_config_version, NULL); 504 static DEVICE_ATTR(status, 0444, stmfts_sysfs_read_status, NULL); 505 static DEVICE_ATTR(hover_enable, 0644, stmfts_sysfs_hover_enable_read, 506 stmfts_sysfs_hover_enable_write); 507 508 static struct attribute *stmfts_sysfs_attrs[] = { 509 &dev_attr_chip_id.attr, 510 &dev_attr_chip_version.attr, 511 &dev_attr_fw_ver.attr, 512 &dev_attr_config_id.attr, 513 &dev_attr_config_version.attr, 514 &dev_attr_status.attr, 515 &dev_attr_hover_enable.attr, 516 NULL 517 }; 518 519 static struct attribute_group stmfts_attribute_group = { 520 .attrs = stmfts_sysfs_attrs 521 }; 522 523 static int stmfts_power_on(struct stmfts_data *sdata) 524 { 525 int err; 526 u8 reg[8]; 527 528 err = regulator_bulk_enable(ARRAY_SIZE(sdata->regulators), 529 sdata->regulators); 530 if (err) 531 return err; 532 533 /* 534 * The datasheet does not specify the power on time, but considering 535 * that the reset time is < 10ms, I sleep 20ms to be sure 536 */ 537 msleep(20); 538 539 err = i2c_smbus_read_i2c_block_data(sdata->client, STMFTS_READ_INFO, 540 sizeof(reg), reg); 541 if (err < 0) 542 return err; 543 if (err != sizeof(reg)) 544 return -EIO; 545 546 sdata->chip_id = be16_to_cpup((__be16 *)®[6]); 547 sdata->chip_ver = reg[0]; 548 sdata->fw_ver = be16_to_cpup((__be16 *)®[2]); 549 sdata->config_id = reg[4]; 550 sdata->config_ver = reg[5]; 551 552 enable_irq(sdata->client->irq); 553 554 msleep(50); 555 556 err = stmfts_command(sdata, STMFTS_SYSTEM_RESET); 557 if (err) 558 return err; 559 560 err = stmfts_command(sdata, STMFTS_SLEEP_OUT); 561 if (err) 562 return err; 563 564 /* optional tuning */ 565 err = stmfts_command(sdata, STMFTS_MS_CX_TUNING); 566 if (err) 567 dev_warn(&sdata->client->dev, 568 "failed to perform mutual auto tune: %d\n", err); 569 570 /* optional tuning */ 571 err = stmfts_command(sdata, STMFTS_SS_CX_TUNING); 572 if (err) 573 dev_warn(&sdata->client->dev, 574 "failed to perform self auto tune: %d\n", err); 575 576 err = stmfts_command(sdata, STMFTS_FULL_FORCE_CALIBRATION); 577 if (err) 578 return err; 579 580 /* 581 * At this point no one is using the touchscreen 582 * and I don't really care about the return value 583 */ 584 (void) i2c_smbus_write_byte(sdata->client, STMFTS_SLEEP_IN); 585 586 return 0; 587 } 588 589 static void stmfts_power_off(void *data) 590 { 591 struct stmfts_data *sdata = data; 592 593 disable_irq(sdata->client->irq); 594 regulator_bulk_disable(ARRAY_SIZE(sdata->regulators), 595 sdata->regulators); 596 } 597 598 /* This function is void because I don't want to prevent using the touch key 599 * only because the LEDs don't get registered 600 */ 601 static int stmfts_enable_led(struct stmfts_data *sdata) 602 { 603 int err; 604 605 /* get the regulator for powering the leds on */ 606 sdata->ledvdd = devm_regulator_get(&sdata->client->dev, "ledvdd"); 607 if (IS_ERR(sdata->ledvdd)) 608 return PTR_ERR(sdata->ledvdd); 609 610 sdata->led_cdev.name = STMFTS_DEV_NAME; 611 sdata->led_cdev.max_brightness = LED_ON; 612 sdata->led_cdev.brightness = LED_OFF; 613 sdata->led_cdev.brightness_set_blocking = stmfts_brightness_set; 614 sdata->led_cdev.brightness_get = stmfts_brightness_get; 615 616 err = devm_led_classdev_register(&sdata->client->dev, &sdata->led_cdev); 617 if (err) { 618 devm_regulator_put(sdata->ledvdd); 619 return err; 620 } 621 622 return 0; 623 } 624 625 static int stmfts_probe(struct i2c_client *client, 626 const struct i2c_device_id *id) 627 { 628 int err; 629 struct stmfts_data *sdata; 630 631 if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C | 632 I2C_FUNC_SMBUS_BYTE_DATA | 633 I2C_FUNC_SMBUS_I2C_BLOCK)) 634 return -ENODEV; 635 636 sdata = devm_kzalloc(&client->dev, sizeof(*sdata), GFP_KERNEL); 637 if (!sdata) 638 return -ENOMEM; 639 640 i2c_set_clientdata(client, sdata); 641 642 sdata->client = client; 643 mutex_init(&sdata->mutex); 644 init_completion(&sdata->cmd_done); 645 646 sdata->regulators[STMFTS_REGULATOR_VDD].supply = "vdd"; 647 sdata->regulators[STMFTS_REGULATOR_AVDD].supply = "avdd"; 648 err = devm_regulator_bulk_get(&client->dev, 649 ARRAY_SIZE(sdata->regulators), 650 sdata->regulators); 651 if (err) 652 return err; 653 654 sdata->input = devm_input_allocate_device(&client->dev); 655 if (!sdata->input) 656 return -ENOMEM; 657 658 sdata->input->name = STMFTS_DEV_NAME; 659 sdata->input->id.bustype = BUS_I2C; 660 sdata->input->open = stmfts_input_open; 661 sdata->input->close = stmfts_input_close; 662 663 input_set_capability(sdata->input, EV_ABS, ABS_MT_POSITION_X); 664 input_set_capability(sdata->input, EV_ABS, ABS_MT_POSITION_Y); 665 touchscreen_parse_properties(sdata->input, true, &sdata->prop); 666 667 input_set_abs_params(sdata->input, ABS_MT_TOUCH_MAJOR, 0, 255, 0, 0); 668 input_set_abs_params(sdata->input, ABS_MT_TOUCH_MINOR, 0, 255, 0, 0); 669 input_set_abs_params(sdata->input, ABS_MT_ORIENTATION, 0, 255, 0, 0); 670 input_set_abs_params(sdata->input, ABS_MT_PRESSURE, 0, 255, 0, 0); 671 input_set_abs_params(sdata->input, ABS_DISTANCE, 0, 255, 0, 0); 672 673 sdata->use_key = device_property_read_bool(&client->dev, 674 "touch-key-connected"); 675 if (sdata->use_key) { 676 input_set_capability(sdata->input, EV_KEY, KEY_MENU); 677 input_set_capability(sdata->input, EV_KEY, KEY_BACK); 678 } 679 680 err = input_mt_init_slots(sdata->input, 681 STMFTS_MAX_FINGERS, INPUT_MT_DIRECT); 682 if (err) 683 return err; 684 685 input_set_drvdata(sdata->input, sdata); 686 687 /* 688 * stmfts_power_on expects interrupt to be disabled, but 689 * at this point the device is still off and I do not trust 690 * the status of the irq line that can generate some spurious 691 * interrupts. To be on the safe side it's better to not enable 692 * the interrupts during their request. 693 */ 694 err = devm_request_threaded_irq(&client->dev, client->irq, 695 NULL, stmfts_irq_handler, 696 IRQF_ONESHOT | IRQF_NO_AUTOEN, 697 "stmfts_irq", sdata); 698 if (err) 699 return err; 700 701 dev_dbg(&client->dev, "initializing ST-Microelectronics FTS...\n"); 702 703 err = stmfts_power_on(sdata); 704 if (err) 705 return err; 706 707 err = devm_add_action_or_reset(&client->dev, stmfts_power_off, sdata); 708 if (err) 709 return err; 710 711 err = input_register_device(sdata->input); 712 if (err) 713 return err; 714 715 if (sdata->use_key) { 716 err = stmfts_enable_led(sdata); 717 if (err) { 718 /* 719 * Even if the LEDs have failed to be initialized and 720 * used in the driver, I can still use the device even 721 * without LEDs. The ledvdd regulator pointer will be 722 * used as a flag. 723 */ 724 dev_warn(&client->dev, "unable to use touchkey leds\n"); 725 sdata->ledvdd = NULL; 726 } 727 } 728 729 err = devm_device_add_group(&client->dev, &stmfts_attribute_group); 730 if (err) 731 return err; 732 733 pm_runtime_enable(&client->dev); 734 device_enable_async_suspend(&client->dev); 735 736 return 0; 737 } 738 739 static int stmfts_remove(struct i2c_client *client) 740 { 741 pm_runtime_disable(&client->dev); 742 743 return 0; 744 } 745 746 static int __maybe_unused stmfts_runtime_suspend(struct device *dev) 747 { 748 struct stmfts_data *sdata = dev_get_drvdata(dev); 749 int ret; 750 751 ret = i2c_smbus_write_byte(sdata->client, STMFTS_SLEEP_IN); 752 if (ret) 753 dev_warn(dev, "failed to suspend device: %d\n", ret); 754 755 return ret; 756 } 757 758 static int __maybe_unused stmfts_runtime_resume(struct device *dev) 759 { 760 struct stmfts_data *sdata = dev_get_drvdata(dev); 761 int ret; 762 763 ret = i2c_smbus_write_byte(sdata->client, STMFTS_SLEEP_OUT); 764 if (ret) 765 dev_err(dev, "failed to resume device: %d\n", ret); 766 767 return ret; 768 } 769 770 static int __maybe_unused stmfts_suspend(struct device *dev) 771 { 772 struct stmfts_data *sdata = dev_get_drvdata(dev); 773 774 stmfts_power_off(sdata); 775 776 return 0; 777 } 778 779 static int __maybe_unused stmfts_resume(struct device *dev) 780 { 781 struct stmfts_data *sdata = dev_get_drvdata(dev); 782 783 return stmfts_power_on(sdata); 784 } 785 786 static const struct dev_pm_ops stmfts_pm_ops = { 787 SET_SYSTEM_SLEEP_PM_OPS(stmfts_suspend, stmfts_resume) 788 SET_RUNTIME_PM_OPS(stmfts_runtime_suspend, stmfts_runtime_resume, NULL) 789 }; 790 791 #ifdef CONFIG_OF 792 static const struct of_device_id stmfts_of_match[] = { 793 { .compatible = "st,stmfts", }, 794 { }, 795 }; 796 MODULE_DEVICE_TABLE(of, stmfts_of_match); 797 #endif 798 799 static const struct i2c_device_id stmfts_id[] = { 800 { "stmfts", 0 }, 801 { }, 802 }; 803 MODULE_DEVICE_TABLE(i2c, stmfts_id); 804 805 static struct i2c_driver stmfts_driver = { 806 .driver = { 807 .name = STMFTS_DEV_NAME, 808 .of_match_table = of_match_ptr(stmfts_of_match), 809 .pm = &stmfts_pm_ops, 810 .probe_type = PROBE_PREFER_ASYNCHRONOUS, 811 }, 812 .probe = stmfts_probe, 813 .remove = stmfts_remove, 814 .id_table = stmfts_id, 815 }; 816 817 module_i2c_driver(stmfts_driver); 818 819 MODULE_AUTHOR("Andi Shyti <andi.shyti@samsung.com>"); 820 MODULE_DESCRIPTION("STMicroelectronics FTS Touch Screen"); 821 MODULE_LICENSE("GPL v2"); 822