1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * File: drivers/input/keyboard/adp5588_keys.c 4 * Description: keypad driver for ADP5588 and ADP5587 5 * I2C QWERTY Keypad and IO Expander 6 * Bugs: Enter bugs at http://blackfin.uclinux.org/ 7 * 8 * Copyright (C) 2008-2010 Analog Devices Inc. 9 */ 10 11 #include <linux/module.h> 12 #include <linux/interrupt.h> 13 #include <linux/irq.h> 14 #include <linux/workqueue.h> 15 #include <linux/errno.h> 16 #include <linux/pm.h> 17 #include <linux/platform_device.h> 18 #include <linux/input.h> 19 #include <linux/i2c.h> 20 #include <linux/gpio.h> 21 #include <linux/slab.h> 22 23 #include <linux/platform_data/adp5588.h> 24 25 /* Key Event Register xy */ 26 #define KEY_EV_PRESSED (1 << 7) 27 #define KEY_EV_MASK (0x7F) 28 29 #define KP_SEL(x) (0xFFFF >> (16 - x)) /* 2^x-1 */ 30 31 #define KEYP_MAX_EVENT 10 32 33 /* 34 * Early pre 4.0 Silicon required to delay readout by at least 25ms, 35 * since the Event Counter Register updated 25ms after the interrupt 36 * asserted. 37 */ 38 #define WA_DELAYED_READOUT_REVID(rev) ((rev) < 4) 39 40 struct adp5588_kpad { 41 struct i2c_client *client; 42 struct input_dev *input; 43 struct delayed_work work; 44 unsigned long delay; 45 unsigned short keycode[ADP5588_KEYMAPSIZE]; 46 const struct adp5588_gpi_map *gpimap; 47 unsigned short gpimapsize; 48 #ifdef CONFIG_GPIOLIB 49 unsigned char gpiomap[ADP5588_MAXGPIO]; 50 bool export_gpio; 51 struct gpio_chip gc; 52 struct mutex gpio_lock; /* Protect cached dir, dat_out */ 53 u8 dat_out[3]; 54 u8 dir[3]; 55 #endif 56 }; 57 58 static int adp5588_read(struct i2c_client *client, u8 reg) 59 { 60 int ret = i2c_smbus_read_byte_data(client, reg); 61 62 if (ret < 0) 63 dev_err(&client->dev, "Read Error\n"); 64 65 return ret; 66 } 67 68 static int adp5588_write(struct i2c_client *client, u8 reg, u8 val) 69 { 70 return i2c_smbus_write_byte_data(client, reg, val); 71 } 72 73 #ifdef CONFIG_GPIOLIB 74 static int adp5588_gpio_get_value(struct gpio_chip *chip, unsigned off) 75 { 76 struct adp5588_kpad *kpad = gpiochip_get_data(chip); 77 unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]); 78 unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]); 79 int val; 80 81 mutex_lock(&kpad->gpio_lock); 82 83 if (kpad->dir[bank] & bit) 84 val = kpad->dat_out[bank]; 85 else 86 val = adp5588_read(kpad->client, GPIO_DAT_STAT1 + bank); 87 88 mutex_unlock(&kpad->gpio_lock); 89 90 return !!(val & bit); 91 } 92 93 static void adp5588_gpio_set_value(struct gpio_chip *chip, 94 unsigned off, int val) 95 { 96 struct adp5588_kpad *kpad = gpiochip_get_data(chip); 97 unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]); 98 unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]); 99 100 mutex_lock(&kpad->gpio_lock); 101 102 if (val) 103 kpad->dat_out[bank] |= bit; 104 else 105 kpad->dat_out[bank] &= ~bit; 106 107 adp5588_write(kpad->client, GPIO_DAT_OUT1 + bank, 108 kpad->dat_out[bank]); 109 110 mutex_unlock(&kpad->gpio_lock); 111 } 112 113 static int adp5588_gpio_direction_input(struct gpio_chip *chip, unsigned off) 114 { 115 struct adp5588_kpad *kpad = gpiochip_get_data(chip); 116 unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]); 117 unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]); 118 int ret; 119 120 mutex_lock(&kpad->gpio_lock); 121 122 kpad->dir[bank] &= ~bit; 123 ret = adp5588_write(kpad->client, GPIO_DIR1 + bank, kpad->dir[bank]); 124 125 mutex_unlock(&kpad->gpio_lock); 126 127 return ret; 128 } 129 130 static int adp5588_gpio_direction_output(struct gpio_chip *chip, 131 unsigned off, int val) 132 { 133 struct adp5588_kpad *kpad = gpiochip_get_data(chip); 134 unsigned int bank = ADP5588_BANK(kpad->gpiomap[off]); 135 unsigned int bit = ADP5588_BIT(kpad->gpiomap[off]); 136 int ret; 137 138 mutex_lock(&kpad->gpio_lock); 139 140 kpad->dir[bank] |= bit; 141 142 if (val) 143 kpad->dat_out[bank] |= bit; 144 else 145 kpad->dat_out[bank] &= ~bit; 146 147 ret = adp5588_write(kpad->client, GPIO_DAT_OUT1 + bank, 148 kpad->dat_out[bank]); 149 ret |= adp5588_write(kpad->client, GPIO_DIR1 + bank, 150 kpad->dir[bank]); 151 152 mutex_unlock(&kpad->gpio_lock); 153 154 return ret; 155 } 156 157 static int adp5588_build_gpiomap(struct adp5588_kpad *kpad, 158 const struct adp5588_kpad_platform_data *pdata) 159 { 160 bool pin_used[ADP5588_MAXGPIO]; 161 int n_unused = 0; 162 int i; 163 164 memset(pin_used, 0, sizeof(pin_used)); 165 166 for (i = 0; i < pdata->rows; i++) 167 pin_used[i] = true; 168 169 for (i = 0; i < pdata->cols; i++) 170 pin_used[i + GPI_PIN_COL_BASE - GPI_PIN_BASE] = true; 171 172 for (i = 0; i < kpad->gpimapsize; i++) 173 pin_used[kpad->gpimap[i].pin - GPI_PIN_BASE] = true; 174 175 for (i = 0; i < ADP5588_MAXGPIO; i++) 176 if (!pin_used[i]) 177 kpad->gpiomap[n_unused++] = i; 178 179 return n_unused; 180 } 181 182 static int adp5588_gpio_add(struct adp5588_kpad *kpad) 183 { 184 struct device *dev = &kpad->client->dev; 185 const struct adp5588_kpad_platform_data *pdata = dev_get_platdata(dev); 186 const struct adp5588_gpio_platform_data *gpio_data = pdata->gpio_data; 187 int i, error; 188 189 if (!gpio_data) 190 return 0; 191 192 kpad->gc.ngpio = adp5588_build_gpiomap(kpad, pdata); 193 if (kpad->gc.ngpio == 0) { 194 dev_info(dev, "No unused gpios left to export\n"); 195 return 0; 196 } 197 198 kpad->export_gpio = true; 199 200 kpad->gc.direction_input = adp5588_gpio_direction_input; 201 kpad->gc.direction_output = adp5588_gpio_direction_output; 202 kpad->gc.get = adp5588_gpio_get_value; 203 kpad->gc.set = adp5588_gpio_set_value; 204 kpad->gc.can_sleep = 1; 205 206 kpad->gc.base = gpio_data->gpio_start; 207 kpad->gc.label = kpad->client->name; 208 kpad->gc.owner = THIS_MODULE; 209 kpad->gc.names = gpio_data->names; 210 211 mutex_init(&kpad->gpio_lock); 212 213 error = gpiochip_add_data(&kpad->gc, kpad); 214 if (error) { 215 dev_err(dev, "gpiochip_add failed, err: %d\n", error); 216 return error; 217 } 218 219 for (i = 0; i <= ADP5588_BANK(ADP5588_MAXGPIO); i++) { 220 kpad->dat_out[i] = adp5588_read(kpad->client, 221 GPIO_DAT_OUT1 + i); 222 kpad->dir[i] = adp5588_read(kpad->client, GPIO_DIR1 + i); 223 } 224 225 if (gpio_data->setup) { 226 error = gpio_data->setup(kpad->client, 227 kpad->gc.base, kpad->gc.ngpio, 228 gpio_data->context); 229 if (error) 230 dev_warn(dev, "setup failed, %d\n", error); 231 } 232 233 return 0; 234 } 235 236 static void adp5588_gpio_remove(struct adp5588_kpad *kpad) 237 { 238 struct device *dev = &kpad->client->dev; 239 const struct adp5588_kpad_platform_data *pdata = dev_get_platdata(dev); 240 const struct adp5588_gpio_platform_data *gpio_data = pdata->gpio_data; 241 int error; 242 243 if (!kpad->export_gpio) 244 return; 245 246 if (gpio_data->teardown) { 247 error = gpio_data->teardown(kpad->client, 248 kpad->gc.base, kpad->gc.ngpio, 249 gpio_data->context); 250 if (error) 251 dev_warn(dev, "teardown failed %d\n", error); 252 } 253 254 gpiochip_remove(&kpad->gc); 255 } 256 #else 257 static inline int adp5588_gpio_add(struct adp5588_kpad *kpad) 258 { 259 return 0; 260 } 261 262 static inline void adp5588_gpio_remove(struct adp5588_kpad *kpad) 263 { 264 } 265 #endif 266 267 static void adp5588_report_events(struct adp5588_kpad *kpad, int ev_cnt) 268 { 269 int i, j; 270 271 for (i = 0; i < ev_cnt; i++) { 272 int key = adp5588_read(kpad->client, Key_EVENTA + i); 273 int key_val = key & KEY_EV_MASK; 274 275 if (key_val >= GPI_PIN_BASE && key_val <= GPI_PIN_END) { 276 for (j = 0; j < kpad->gpimapsize; j++) { 277 if (key_val == kpad->gpimap[j].pin) { 278 input_report_switch(kpad->input, 279 kpad->gpimap[j].sw_evt, 280 key & KEY_EV_PRESSED); 281 break; 282 } 283 } 284 } else { 285 input_report_key(kpad->input, 286 kpad->keycode[key_val - 1], 287 key & KEY_EV_PRESSED); 288 } 289 } 290 } 291 292 static void adp5588_work(struct work_struct *work) 293 { 294 struct adp5588_kpad *kpad = container_of(work, 295 struct adp5588_kpad, work.work); 296 struct i2c_client *client = kpad->client; 297 int status, ev_cnt; 298 299 status = adp5588_read(client, INT_STAT); 300 301 if (status & ADP5588_OVR_FLOW_INT) /* Unlikely and should never happen */ 302 dev_err(&client->dev, "Event Overflow Error\n"); 303 304 if (status & ADP5588_KE_INT) { 305 ev_cnt = adp5588_read(client, KEY_LCK_EC_STAT) & ADP5588_KEC; 306 if (ev_cnt) { 307 adp5588_report_events(kpad, ev_cnt); 308 input_sync(kpad->input); 309 } 310 } 311 adp5588_write(client, INT_STAT, status); /* Status is W1C */ 312 } 313 314 static irqreturn_t adp5588_irq(int irq, void *handle) 315 { 316 struct adp5588_kpad *kpad = handle; 317 318 /* 319 * use keventd context to read the event fifo registers 320 * Schedule readout at least 25ms after notification for 321 * REVID < 4 322 */ 323 324 schedule_delayed_work(&kpad->work, kpad->delay); 325 326 return IRQ_HANDLED; 327 } 328 329 static int adp5588_setup(struct i2c_client *client) 330 { 331 const struct adp5588_kpad_platform_data *pdata = 332 dev_get_platdata(&client->dev); 333 const struct adp5588_gpio_platform_data *gpio_data = pdata->gpio_data; 334 int i, ret; 335 unsigned char evt_mode1 = 0, evt_mode2 = 0, evt_mode3 = 0; 336 337 ret = adp5588_write(client, KP_GPIO1, KP_SEL(pdata->rows)); 338 ret |= adp5588_write(client, KP_GPIO2, KP_SEL(pdata->cols) & 0xFF); 339 ret |= adp5588_write(client, KP_GPIO3, KP_SEL(pdata->cols) >> 8); 340 341 if (pdata->en_keylock) { 342 ret |= adp5588_write(client, UNLOCK1, pdata->unlock_key1); 343 ret |= adp5588_write(client, UNLOCK2, pdata->unlock_key2); 344 ret |= adp5588_write(client, KEY_LCK_EC_STAT, ADP5588_K_LCK_EN); 345 } 346 347 for (i = 0; i < KEYP_MAX_EVENT; i++) 348 ret |= adp5588_read(client, Key_EVENTA); 349 350 for (i = 0; i < pdata->gpimapsize; i++) { 351 unsigned short pin = pdata->gpimap[i].pin; 352 353 if (pin <= GPI_PIN_ROW_END) { 354 evt_mode1 |= (1 << (pin - GPI_PIN_ROW_BASE)); 355 } else { 356 evt_mode2 |= ((1 << (pin - GPI_PIN_COL_BASE)) & 0xFF); 357 evt_mode3 |= ((1 << (pin - GPI_PIN_COL_BASE)) >> 8); 358 } 359 } 360 361 if (pdata->gpimapsize) { 362 ret |= adp5588_write(client, GPI_EM1, evt_mode1); 363 ret |= adp5588_write(client, GPI_EM2, evt_mode2); 364 ret |= adp5588_write(client, GPI_EM3, evt_mode3); 365 } 366 367 if (gpio_data) { 368 for (i = 0; i <= ADP5588_BANK(ADP5588_MAXGPIO); i++) { 369 int pull_mask = gpio_data->pullup_dis_mask; 370 371 ret |= adp5588_write(client, GPIO_PULL1 + i, 372 (pull_mask >> (8 * i)) & 0xFF); 373 } 374 } 375 376 ret |= adp5588_write(client, INT_STAT, 377 ADP5588_CMP2_INT | ADP5588_CMP1_INT | 378 ADP5588_OVR_FLOW_INT | ADP5588_K_LCK_INT | 379 ADP5588_GPI_INT | ADP5588_KE_INT); /* Status is W1C */ 380 381 ret |= adp5588_write(client, CFG, ADP5588_INT_CFG | 382 ADP5588_OVR_FLOW_IEN | 383 ADP5588_KE_IEN); 384 385 if (ret < 0) { 386 dev_err(&client->dev, "Write Error\n"); 387 return ret; 388 } 389 390 return 0; 391 } 392 393 static void adp5588_report_switch_state(struct adp5588_kpad *kpad) 394 { 395 int gpi_stat1 = adp5588_read(kpad->client, GPIO_DAT_STAT1); 396 int gpi_stat2 = adp5588_read(kpad->client, GPIO_DAT_STAT2); 397 int gpi_stat3 = adp5588_read(kpad->client, GPIO_DAT_STAT3); 398 int gpi_stat_tmp, pin_loc; 399 int i; 400 401 for (i = 0; i < kpad->gpimapsize; i++) { 402 unsigned short pin = kpad->gpimap[i].pin; 403 404 if (pin <= GPI_PIN_ROW_END) { 405 gpi_stat_tmp = gpi_stat1; 406 pin_loc = pin - GPI_PIN_ROW_BASE; 407 } else if ((pin - GPI_PIN_COL_BASE) < 8) { 408 gpi_stat_tmp = gpi_stat2; 409 pin_loc = pin - GPI_PIN_COL_BASE; 410 } else { 411 gpi_stat_tmp = gpi_stat3; 412 pin_loc = pin - GPI_PIN_COL_BASE - 8; 413 } 414 415 if (gpi_stat_tmp < 0) { 416 dev_err(&kpad->client->dev, 417 "Can't read GPIO_DAT_STAT switch %d default to OFF\n", 418 pin); 419 gpi_stat_tmp = 0; 420 } 421 422 input_report_switch(kpad->input, 423 kpad->gpimap[i].sw_evt, 424 !(gpi_stat_tmp & (1 << pin_loc))); 425 } 426 427 input_sync(kpad->input); 428 } 429 430 431 static int adp5588_probe(struct i2c_client *client, 432 const struct i2c_device_id *id) 433 { 434 struct adp5588_kpad *kpad; 435 const struct adp5588_kpad_platform_data *pdata = 436 dev_get_platdata(&client->dev); 437 struct input_dev *input; 438 unsigned int revid; 439 int ret, i; 440 int error; 441 442 if (!i2c_check_functionality(client->adapter, 443 I2C_FUNC_SMBUS_BYTE_DATA)) { 444 dev_err(&client->dev, "SMBUS Byte Data not Supported\n"); 445 return -EIO; 446 } 447 448 if (!pdata) { 449 dev_err(&client->dev, "no platform data?\n"); 450 return -EINVAL; 451 } 452 453 if (!pdata->rows || !pdata->cols || !pdata->keymap) { 454 dev_err(&client->dev, "no rows, cols or keymap from pdata\n"); 455 return -EINVAL; 456 } 457 458 if (pdata->keymapsize != ADP5588_KEYMAPSIZE) { 459 dev_err(&client->dev, "invalid keymapsize\n"); 460 return -EINVAL; 461 } 462 463 if (!pdata->gpimap && pdata->gpimapsize) { 464 dev_err(&client->dev, "invalid gpimap from pdata\n"); 465 return -EINVAL; 466 } 467 468 if (pdata->gpimapsize > ADP5588_GPIMAPSIZE_MAX) { 469 dev_err(&client->dev, "invalid gpimapsize\n"); 470 return -EINVAL; 471 } 472 473 for (i = 0; i < pdata->gpimapsize; i++) { 474 unsigned short pin = pdata->gpimap[i].pin; 475 476 if (pin < GPI_PIN_BASE || pin > GPI_PIN_END) { 477 dev_err(&client->dev, "invalid gpi pin data\n"); 478 return -EINVAL; 479 } 480 481 if (pin <= GPI_PIN_ROW_END) { 482 if (pin - GPI_PIN_ROW_BASE + 1 <= pdata->rows) { 483 dev_err(&client->dev, "invalid gpi row data\n"); 484 return -EINVAL; 485 } 486 } else { 487 if (pin - GPI_PIN_COL_BASE + 1 <= pdata->cols) { 488 dev_err(&client->dev, "invalid gpi col data\n"); 489 return -EINVAL; 490 } 491 } 492 } 493 494 if (!client->irq) { 495 dev_err(&client->dev, "no IRQ?\n"); 496 return -EINVAL; 497 } 498 499 kpad = kzalloc(sizeof(*kpad), GFP_KERNEL); 500 input = input_allocate_device(); 501 if (!kpad || !input) { 502 error = -ENOMEM; 503 goto err_free_mem; 504 } 505 506 kpad->client = client; 507 kpad->input = input; 508 INIT_DELAYED_WORK(&kpad->work, adp5588_work); 509 510 ret = adp5588_read(client, DEV_ID); 511 if (ret < 0) { 512 error = ret; 513 goto err_free_mem; 514 } 515 516 revid = (u8) ret & ADP5588_DEVICE_ID_MASK; 517 if (WA_DELAYED_READOUT_REVID(revid)) 518 kpad->delay = msecs_to_jiffies(30); 519 520 input->name = client->name; 521 input->phys = "adp5588-keys/input0"; 522 input->dev.parent = &client->dev; 523 524 input_set_drvdata(input, kpad); 525 526 input->id.bustype = BUS_I2C; 527 input->id.vendor = 0x0001; 528 input->id.product = 0x0001; 529 input->id.version = revid; 530 531 input->keycodesize = sizeof(kpad->keycode[0]); 532 input->keycodemax = pdata->keymapsize; 533 input->keycode = kpad->keycode; 534 535 memcpy(kpad->keycode, pdata->keymap, 536 pdata->keymapsize * input->keycodesize); 537 538 kpad->gpimap = pdata->gpimap; 539 kpad->gpimapsize = pdata->gpimapsize; 540 541 /* setup input device */ 542 __set_bit(EV_KEY, input->evbit); 543 544 if (pdata->repeat) 545 __set_bit(EV_REP, input->evbit); 546 547 for (i = 0; i < input->keycodemax; i++) 548 if (kpad->keycode[i] <= KEY_MAX) 549 __set_bit(kpad->keycode[i], input->keybit); 550 __clear_bit(KEY_RESERVED, input->keybit); 551 552 if (kpad->gpimapsize) 553 __set_bit(EV_SW, input->evbit); 554 for (i = 0; i < kpad->gpimapsize; i++) 555 __set_bit(kpad->gpimap[i].sw_evt, input->swbit); 556 557 error = input_register_device(input); 558 if (error) { 559 dev_err(&client->dev, "unable to register input device\n"); 560 goto err_free_mem; 561 } 562 563 error = request_irq(client->irq, adp5588_irq, 564 IRQF_TRIGGER_FALLING, 565 client->dev.driver->name, kpad); 566 if (error) { 567 dev_err(&client->dev, "irq %d busy?\n", client->irq); 568 goto err_unreg_dev; 569 } 570 571 error = adp5588_setup(client); 572 if (error) 573 goto err_free_irq; 574 575 if (kpad->gpimapsize) 576 adp5588_report_switch_state(kpad); 577 578 error = adp5588_gpio_add(kpad); 579 if (error) 580 goto err_free_irq; 581 582 device_init_wakeup(&client->dev, 1); 583 i2c_set_clientdata(client, kpad); 584 585 dev_info(&client->dev, "Rev.%d keypad, irq %d\n", revid, client->irq); 586 return 0; 587 588 err_free_irq: 589 free_irq(client->irq, kpad); 590 cancel_delayed_work_sync(&kpad->work); 591 err_unreg_dev: 592 input_unregister_device(input); 593 input = NULL; 594 err_free_mem: 595 input_free_device(input); 596 kfree(kpad); 597 598 return error; 599 } 600 601 static int adp5588_remove(struct i2c_client *client) 602 { 603 struct adp5588_kpad *kpad = i2c_get_clientdata(client); 604 605 adp5588_write(client, CFG, 0); 606 free_irq(client->irq, kpad); 607 cancel_delayed_work_sync(&kpad->work); 608 input_unregister_device(kpad->input); 609 adp5588_gpio_remove(kpad); 610 kfree(kpad); 611 612 return 0; 613 } 614 615 #ifdef CONFIG_PM 616 static int adp5588_suspend(struct device *dev) 617 { 618 struct adp5588_kpad *kpad = dev_get_drvdata(dev); 619 struct i2c_client *client = kpad->client; 620 621 disable_irq(client->irq); 622 cancel_delayed_work_sync(&kpad->work); 623 624 if (device_may_wakeup(&client->dev)) 625 enable_irq_wake(client->irq); 626 627 return 0; 628 } 629 630 static int adp5588_resume(struct device *dev) 631 { 632 struct adp5588_kpad *kpad = dev_get_drvdata(dev); 633 struct i2c_client *client = kpad->client; 634 635 if (device_may_wakeup(&client->dev)) 636 disable_irq_wake(client->irq); 637 638 enable_irq(client->irq); 639 640 return 0; 641 } 642 643 static const struct dev_pm_ops adp5588_dev_pm_ops = { 644 .suspend = adp5588_suspend, 645 .resume = adp5588_resume, 646 }; 647 #endif 648 649 static const struct i2c_device_id adp5588_id[] = { 650 { "adp5588-keys", 0 }, 651 { "adp5587-keys", 0 }, 652 { } 653 }; 654 MODULE_DEVICE_TABLE(i2c, adp5588_id); 655 656 static struct i2c_driver adp5588_driver = { 657 .driver = { 658 .name = KBUILD_MODNAME, 659 #ifdef CONFIG_PM 660 .pm = &adp5588_dev_pm_ops, 661 #endif 662 }, 663 .probe = adp5588_probe, 664 .remove = adp5588_remove, 665 .id_table = adp5588_id, 666 }; 667 668 module_i2c_driver(adp5588_driver); 669 670 MODULE_LICENSE("GPL"); 671 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>"); 672 MODULE_DESCRIPTION("ADP5588/87 Keypad driver"); 673