1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * qt2160.c - Atmel AT42QT2160 Touch Sense Controller 4 * 5 * Copyright (C) 2009 Raphael Derosso Pereira <raphaelpereira@gmail.com> 6 */ 7 8 #include <linux/kernel.h> 9 #include <linux/leds.h> 10 #include <linux/module.h> 11 #include <linux/slab.h> 12 #include <linux/jiffies.h> 13 #include <linux/i2c.h> 14 #include <linux/irq.h> 15 #include <linux/interrupt.h> 16 #include <linux/input.h> 17 18 #define QT2160_VALID_CHIPID 0x11 19 20 #define QT2160_CMD_CHIPID 0 21 #define QT2160_CMD_CODEVER 1 22 #define QT2160_CMD_GSTAT 2 23 #define QT2160_CMD_KEYS3 3 24 #define QT2160_CMD_KEYS4 4 25 #define QT2160_CMD_SLIDE 5 26 #define QT2160_CMD_GPIOS 6 27 #define QT2160_CMD_SUBVER 7 28 #define QT2160_CMD_CALIBRATE 10 29 #define QT2160_CMD_DRIVE_X 70 30 #define QT2160_CMD_PWMEN_X 74 31 #define QT2160_CMD_PWM_DUTY 76 32 33 #define QT2160_NUM_LEDS_X 8 34 35 #define QT2160_CYCLE_INTERVAL (2*HZ) 36 37 static unsigned char qt2160_key2code[] = { 38 KEY_0, KEY_1, KEY_2, KEY_3, 39 KEY_4, KEY_5, KEY_6, KEY_7, 40 KEY_8, KEY_9, KEY_A, KEY_B, 41 KEY_C, KEY_D, KEY_E, KEY_F, 42 }; 43 44 #ifdef CONFIG_LEDS_CLASS 45 struct qt2160_led { 46 struct qt2160_data *qt2160; 47 struct led_classdev cdev; 48 char name[32]; 49 int id; 50 enum led_brightness brightness; 51 }; 52 #endif 53 54 struct qt2160_data { 55 struct i2c_client *client; 56 struct input_dev *input; 57 struct delayed_work dwork; 58 unsigned short keycodes[ARRAY_SIZE(qt2160_key2code)]; 59 u16 key_matrix; 60 #ifdef CONFIG_LEDS_CLASS 61 struct qt2160_led leds[QT2160_NUM_LEDS_X]; 62 #endif 63 }; 64 65 static int qt2160_read(struct i2c_client *client, u8 reg); 66 static int qt2160_write(struct i2c_client *client, u8 reg, u8 data); 67 68 #ifdef CONFIG_LEDS_CLASS 69 70 static int qt2160_led_set(struct led_classdev *cdev, 71 enum led_brightness value) 72 { 73 struct qt2160_led *led = container_of(cdev, struct qt2160_led, cdev); 74 struct qt2160_data *qt2160 = led->qt2160; 75 struct i2c_client *client = qt2160->client; 76 u32 drive, pwmen; 77 78 if (value != led->brightness) { 79 drive = qt2160_read(client, QT2160_CMD_DRIVE_X); 80 pwmen = qt2160_read(client, QT2160_CMD_PWMEN_X); 81 if (value != LED_OFF) { 82 drive |= BIT(led->id); 83 pwmen |= BIT(led->id); 84 85 } else { 86 drive &= ~BIT(led->id); 87 pwmen &= ~BIT(led->id); 88 } 89 qt2160_write(client, QT2160_CMD_DRIVE_X, drive); 90 qt2160_write(client, QT2160_CMD_PWMEN_X, pwmen); 91 92 /* 93 * Changing this register will change the brightness 94 * of every LED in the qt2160. It's a HW limitation. 95 */ 96 if (value != LED_OFF) 97 qt2160_write(client, QT2160_CMD_PWM_DUTY, value); 98 99 led->brightness = value; 100 } 101 102 return 0; 103 } 104 105 #endif /* CONFIG_LEDS_CLASS */ 106 107 static int qt2160_read_block(struct i2c_client *client, 108 u8 inireg, u8 *buffer, unsigned int count) 109 { 110 int error, idx = 0; 111 112 /* 113 * Can't use SMBus block data read. Check for I2C functionality to speed 114 * things up whenever possible. Otherwise we will be forced to read 115 * sequentially. 116 */ 117 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { 118 119 error = i2c_smbus_write_byte(client, inireg + idx); 120 if (error) { 121 dev_err(&client->dev, 122 "couldn't send request. Returned %d\n", error); 123 return error; 124 } 125 126 error = i2c_master_recv(client, buffer, count); 127 if (error != count) { 128 dev_err(&client->dev, 129 "couldn't read registers. Returned %d bytes\n", error); 130 return error; 131 } 132 } else { 133 134 while (count--) { 135 int data; 136 137 error = i2c_smbus_write_byte(client, inireg + idx); 138 if (error) { 139 dev_err(&client->dev, 140 "couldn't send request. Returned %d\n", error); 141 return error; 142 } 143 144 data = i2c_smbus_read_byte(client); 145 if (data < 0) { 146 dev_err(&client->dev, 147 "couldn't read register. Returned %d\n", data); 148 return data; 149 } 150 151 buffer[idx++] = data; 152 } 153 } 154 155 return 0; 156 } 157 158 static int qt2160_get_key_matrix(struct qt2160_data *qt2160) 159 { 160 struct i2c_client *client = qt2160->client; 161 struct input_dev *input = qt2160->input; 162 u8 regs[6]; 163 u16 old_matrix, new_matrix; 164 int ret, i, mask; 165 166 dev_dbg(&client->dev, "requesting keys...\n"); 167 168 /* 169 * Read all registers from General Status Register 170 * to GPIOs register 171 */ 172 ret = qt2160_read_block(client, QT2160_CMD_GSTAT, regs, 6); 173 if (ret) { 174 dev_err(&client->dev, 175 "could not perform chip read.\n"); 176 return ret; 177 } 178 179 old_matrix = qt2160->key_matrix; 180 qt2160->key_matrix = new_matrix = (regs[2] << 8) | regs[1]; 181 182 mask = 0x01; 183 for (i = 0; i < 16; ++i, mask <<= 1) { 184 int keyval = new_matrix & mask; 185 186 if ((old_matrix & mask) != keyval) { 187 input_report_key(input, qt2160->keycodes[i], keyval); 188 dev_dbg(&client->dev, "key %d %s\n", 189 i, keyval ? "pressed" : "released"); 190 } 191 } 192 193 input_sync(input); 194 195 return 0; 196 } 197 198 static irqreturn_t qt2160_irq(int irq, void *_qt2160) 199 { 200 struct qt2160_data *qt2160 = _qt2160; 201 202 mod_delayed_work(system_wq, &qt2160->dwork, 0); 203 204 return IRQ_HANDLED; 205 } 206 207 static void qt2160_schedule_read(struct qt2160_data *qt2160) 208 { 209 schedule_delayed_work(&qt2160->dwork, QT2160_CYCLE_INTERVAL); 210 } 211 212 static void qt2160_worker(struct work_struct *work) 213 { 214 struct qt2160_data *qt2160 = 215 container_of(work, struct qt2160_data, dwork.work); 216 217 dev_dbg(&qt2160->client->dev, "worker\n"); 218 219 qt2160_get_key_matrix(qt2160); 220 221 /* Avoid device lock up by checking every so often */ 222 qt2160_schedule_read(qt2160); 223 } 224 225 static int qt2160_read(struct i2c_client *client, u8 reg) 226 { 227 int ret; 228 229 ret = i2c_smbus_write_byte(client, reg); 230 if (ret) { 231 dev_err(&client->dev, 232 "couldn't send request. Returned %d\n", ret); 233 return ret; 234 } 235 236 ret = i2c_smbus_read_byte(client); 237 if (ret < 0) { 238 dev_err(&client->dev, 239 "couldn't read register. Returned %d\n", ret); 240 return ret; 241 } 242 243 return ret; 244 } 245 246 static int qt2160_write(struct i2c_client *client, u8 reg, u8 data) 247 { 248 int ret; 249 250 ret = i2c_smbus_write_byte_data(client, reg, data); 251 if (ret < 0) 252 dev_err(&client->dev, 253 "couldn't write data. Returned %d\n", ret); 254 255 return ret; 256 } 257 258 #ifdef CONFIG_LEDS_CLASS 259 260 static int qt2160_register_leds(struct qt2160_data *qt2160) 261 { 262 struct i2c_client *client = qt2160->client; 263 int ret; 264 int i; 265 266 for (i = 0; i < QT2160_NUM_LEDS_X; i++) { 267 struct qt2160_led *led = &qt2160->leds[i]; 268 269 snprintf(led->name, sizeof(led->name), "qt2160:x%d", i); 270 led->cdev.name = led->name; 271 led->cdev.brightness_set_blocking = qt2160_led_set; 272 led->cdev.brightness = LED_OFF; 273 led->id = i; 274 led->qt2160 = qt2160; 275 276 ret = led_classdev_register(&client->dev, &led->cdev); 277 if (ret < 0) 278 return ret; 279 } 280 281 /* Tur off LEDs */ 282 qt2160_write(client, QT2160_CMD_DRIVE_X, 0); 283 qt2160_write(client, QT2160_CMD_PWMEN_X, 0); 284 qt2160_write(client, QT2160_CMD_PWM_DUTY, 0); 285 286 return 0; 287 } 288 289 static void qt2160_unregister_leds(struct qt2160_data *qt2160) 290 { 291 int i; 292 293 for (i = 0; i < QT2160_NUM_LEDS_X; i++) 294 led_classdev_unregister(&qt2160->leds[i].cdev); 295 } 296 297 #else 298 299 static inline int qt2160_register_leds(struct qt2160_data *qt2160) 300 { 301 return 0; 302 } 303 304 static inline void qt2160_unregister_leds(struct qt2160_data *qt2160) 305 { 306 } 307 308 #endif 309 310 static bool qt2160_identify(struct i2c_client *client) 311 { 312 int id, ver, rev; 313 314 /* Read Chid ID to check if chip is valid */ 315 id = qt2160_read(client, QT2160_CMD_CHIPID); 316 if (id != QT2160_VALID_CHIPID) { 317 dev_err(&client->dev, "ID %d not supported\n", id); 318 return false; 319 } 320 321 /* Read chip firmware version */ 322 ver = qt2160_read(client, QT2160_CMD_CODEVER); 323 if (ver < 0) { 324 dev_err(&client->dev, "could not get firmware version\n"); 325 return false; 326 } 327 328 /* Read chip firmware revision */ 329 rev = qt2160_read(client, QT2160_CMD_SUBVER); 330 if (rev < 0) { 331 dev_err(&client->dev, "could not get firmware revision\n"); 332 return false; 333 } 334 335 dev_info(&client->dev, "AT42QT2160 firmware version %d.%d.%d\n", 336 ver >> 4, ver & 0xf, rev); 337 338 return true; 339 } 340 341 static int qt2160_probe(struct i2c_client *client) 342 { 343 struct qt2160_data *qt2160; 344 struct input_dev *input; 345 int i; 346 int error; 347 348 /* Check functionality */ 349 error = i2c_check_functionality(client->adapter, 350 I2C_FUNC_SMBUS_BYTE); 351 if (!error) { 352 dev_err(&client->dev, "%s adapter not supported\n", 353 dev_driver_string(&client->adapter->dev)); 354 return -ENODEV; 355 } 356 357 if (!qt2160_identify(client)) 358 return -ENODEV; 359 360 /* Chip is valid and active. Allocate structure */ 361 qt2160 = kzalloc(sizeof(struct qt2160_data), GFP_KERNEL); 362 input = input_allocate_device(); 363 if (!qt2160 || !input) { 364 dev_err(&client->dev, "insufficient memory\n"); 365 error = -ENOMEM; 366 goto err_free_mem; 367 } 368 369 qt2160->client = client; 370 qt2160->input = input; 371 INIT_DELAYED_WORK(&qt2160->dwork, qt2160_worker); 372 373 input->name = "AT42QT2160 Touch Sense Keyboard"; 374 input->id.bustype = BUS_I2C; 375 376 input->keycode = qt2160->keycodes; 377 input->keycodesize = sizeof(qt2160->keycodes[0]); 378 input->keycodemax = ARRAY_SIZE(qt2160_key2code); 379 380 __set_bit(EV_KEY, input->evbit); 381 __clear_bit(EV_REP, input->evbit); 382 for (i = 0; i < ARRAY_SIZE(qt2160_key2code); i++) { 383 qt2160->keycodes[i] = qt2160_key2code[i]; 384 __set_bit(qt2160_key2code[i], input->keybit); 385 } 386 __clear_bit(KEY_RESERVED, input->keybit); 387 388 /* Calibrate device */ 389 error = qt2160_write(client, QT2160_CMD_CALIBRATE, 1); 390 if (error) { 391 dev_err(&client->dev, "failed to calibrate device\n"); 392 goto err_free_mem; 393 } 394 395 if (client->irq) { 396 error = request_irq(client->irq, qt2160_irq, 397 IRQF_TRIGGER_FALLING, "qt2160", qt2160); 398 if (error) { 399 dev_err(&client->dev, 400 "failed to allocate irq %d\n", client->irq); 401 goto err_free_mem; 402 } 403 } 404 405 error = qt2160_register_leds(qt2160); 406 if (error) { 407 dev_err(&client->dev, "Failed to register leds\n"); 408 goto err_free_irq; 409 } 410 411 error = input_register_device(qt2160->input); 412 if (error) { 413 dev_err(&client->dev, 414 "Failed to register input device\n"); 415 goto err_unregister_leds; 416 } 417 418 i2c_set_clientdata(client, qt2160); 419 qt2160_schedule_read(qt2160); 420 421 return 0; 422 423 err_unregister_leds: 424 qt2160_unregister_leds(qt2160); 425 err_free_irq: 426 if (client->irq) 427 free_irq(client->irq, qt2160); 428 err_free_mem: 429 input_free_device(input); 430 kfree(qt2160); 431 return error; 432 } 433 434 static void qt2160_remove(struct i2c_client *client) 435 { 436 struct qt2160_data *qt2160 = i2c_get_clientdata(client); 437 438 qt2160_unregister_leds(qt2160); 439 440 /* Release IRQ so no queue will be scheduled */ 441 if (client->irq) 442 free_irq(client->irq, qt2160); 443 444 cancel_delayed_work_sync(&qt2160->dwork); 445 446 input_unregister_device(qt2160->input); 447 kfree(qt2160); 448 } 449 450 static const struct i2c_device_id qt2160_idtable[] = { 451 { "qt2160", 0, }, 452 { } 453 }; 454 455 MODULE_DEVICE_TABLE(i2c, qt2160_idtable); 456 457 static struct i2c_driver qt2160_driver = { 458 .driver = { 459 .name = "qt2160", 460 }, 461 462 .id_table = qt2160_idtable, 463 .probe_new = qt2160_probe, 464 .remove = qt2160_remove, 465 }; 466 467 module_i2c_driver(qt2160_driver); 468 469 MODULE_AUTHOR("Raphael Derosso Pereira <raphaelpereira@gmail.com>"); 470 MODULE_DESCRIPTION("Driver for AT42QT2160 Touch Sensor"); 471 MODULE_LICENSE("GPL"); 472