1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Driver for a keypad w/16 buttons connected to a PCF8574 I2C I/O expander 4 * 5 * Copyright 2005-2008 Analog Devices Inc. 6 */ 7 8 #include <linux/module.h> 9 #include <linux/input.h> 10 #include <linux/interrupt.h> 11 #include <linux/i2c.h> 12 #include <linux/slab.h> 13 #include <linux/workqueue.h> 14 15 #define DRV_NAME "pcf8574_keypad" 16 17 static const unsigned char pcf8574_kp_btncode[] = { 18 [0] = KEY_RESERVED, 19 [1] = KEY_ENTER, 20 [2] = KEY_BACKSLASH, 21 [3] = KEY_0, 22 [4] = KEY_RIGHTBRACE, 23 [5] = KEY_C, 24 [6] = KEY_9, 25 [7] = KEY_8, 26 [8] = KEY_7, 27 [9] = KEY_B, 28 [10] = KEY_6, 29 [11] = KEY_5, 30 [12] = KEY_4, 31 [13] = KEY_A, 32 [14] = KEY_3, 33 [15] = KEY_2, 34 [16] = KEY_1 35 }; 36 37 struct kp_data { 38 unsigned short btncode[ARRAY_SIZE(pcf8574_kp_btncode)]; 39 struct input_dev *idev; 40 struct i2c_client *client; 41 char name[64]; 42 char phys[32]; 43 unsigned char laststate; 44 }; 45 read_state(struct kp_data * lp)46 static short read_state(struct kp_data *lp) 47 { 48 unsigned char x, y, a, b; 49 50 i2c_smbus_write_byte(lp->client, 240); 51 x = 0xF & (~(i2c_smbus_read_byte(lp->client) >> 4)); 52 53 i2c_smbus_write_byte(lp->client, 15); 54 y = 0xF & (~i2c_smbus_read_byte(lp->client)); 55 56 for (a = 0; x > 0; a++) 57 x = x >> 1; 58 for (b = 0; y > 0; b++) 59 y = y >> 1; 60 61 return ((a - 1) * 4) + b; 62 } 63 pcf8574_kp_irq_handler(int irq,void * dev_id)64 static irqreturn_t pcf8574_kp_irq_handler(int irq, void *dev_id) 65 { 66 struct kp_data *lp = dev_id; 67 unsigned char nextstate = read_state(lp); 68 69 if (lp->laststate != nextstate) { 70 int key_down = nextstate < ARRAY_SIZE(lp->btncode); 71 unsigned short keycode = key_down ? 72 lp->btncode[nextstate] : lp->btncode[lp->laststate]; 73 74 input_report_key(lp->idev, keycode, key_down); 75 input_sync(lp->idev); 76 77 lp->laststate = nextstate; 78 } 79 80 return IRQ_HANDLED; 81 } 82 pcf8574_kp_probe(struct i2c_client * client)83 static int pcf8574_kp_probe(struct i2c_client *client) 84 { 85 int i, ret; 86 struct input_dev *idev; 87 struct kp_data *lp; 88 89 if (i2c_smbus_write_byte(client, 240) < 0) { 90 dev_err(&client->dev, "probe: write fail\n"); 91 return -ENODEV; 92 } 93 94 lp = kzalloc(sizeof(*lp), GFP_KERNEL); 95 if (!lp) 96 return -ENOMEM; 97 98 idev = input_allocate_device(); 99 if (!idev) { 100 dev_err(&client->dev, "Can't allocate input device\n"); 101 ret = -ENOMEM; 102 goto fail_allocate; 103 } 104 105 lp->idev = idev; 106 lp->client = client; 107 108 idev->evbit[0] = BIT_MASK(EV_KEY); 109 idev->keycode = lp->btncode; 110 idev->keycodesize = sizeof(lp->btncode[0]); 111 idev->keycodemax = ARRAY_SIZE(lp->btncode); 112 113 for (i = 0; i < ARRAY_SIZE(pcf8574_kp_btncode); i++) { 114 if (lp->btncode[i] <= KEY_MAX) { 115 lp->btncode[i] = pcf8574_kp_btncode[i]; 116 __set_bit(lp->btncode[i], idev->keybit); 117 } 118 } 119 __clear_bit(KEY_RESERVED, idev->keybit); 120 121 sprintf(lp->name, DRV_NAME); 122 sprintf(lp->phys, "kp_data/input0"); 123 124 idev->name = lp->name; 125 idev->phys = lp->phys; 126 idev->id.bustype = BUS_I2C; 127 idev->id.vendor = 0x0001; 128 idev->id.product = 0x0001; 129 idev->id.version = 0x0100; 130 131 lp->laststate = read_state(lp); 132 133 ret = request_threaded_irq(client->irq, NULL, pcf8574_kp_irq_handler, 134 IRQF_TRIGGER_LOW | IRQF_ONESHOT, 135 DRV_NAME, lp); 136 if (ret) { 137 dev_err(&client->dev, "IRQ %d is not free\n", client->irq); 138 goto fail_free_device; 139 } 140 141 ret = input_register_device(idev); 142 if (ret) { 143 dev_err(&client->dev, "input_register_device() failed\n"); 144 goto fail_free_irq; 145 } 146 147 i2c_set_clientdata(client, lp); 148 return 0; 149 150 fail_free_irq: 151 free_irq(client->irq, lp); 152 fail_free_device: 153 input_free_device(idev); 154 fail_allocate: 155 kfree(lp); 156 157 return ret; 158 } 159 pcf8574_kp_remove(struct i2c_client * client)160 static void pcf8574_kp_remove(struct i2c_client *client) 161 { 162 struct kp_data *lp = i2c_get_clientdata(client); 163 164 free_irq(client->irq, lp); 165 166 input_unregister_device(lp->idev); 167 kfree(lp); 168 } 169 pcf8574_kp_resume(struct device * dev)170 static int pcf8574_kp_resume(struct device *dev) 171 { 172 struct i2c_client *client = to_i2c_client(dev); 173 174 enable_irq(client->irq); 175 176 return 0; 177 } 178 pcf8574_kp_suspend(struct device * dev)179 static int pcf8574_kp_suspend(struct device *dev) 180 { 181 struct i2c_client *client = to_i2c_client(dev); 182 183 disable_irq(client->irq); 184 185 return 0; 186 } 187 188 static DEFINE_SIMPLE_DEV_PM_OPS(pcf8574_kp_pm_ops, 189 pcf8574_kp_suspend, pcf8574_kp_resume); 190 191 static const struct i2c_device_id pcf8574_kp_id[] = { 192 { DRV_NAME, 0 }, 193 { } 194 }; 195 MODULE_DEVICE_TABLE(i2c, pcf8574_kp_id); 196 197 static struct i2c_driver pcf8574_kp_driver = { 198 .driver = { 199 .name = DRV_NAME, 200 .pm = pm_sleep_ptr(&pcf8574_kp_pm_ops), 201 }, 202 .probe = pcf8574_kp_probe, 203 .remove = pcf8574_kp_remove, 204 .id_table = pcf8574_kp_id, 205 }; 206 207 module_i2c_driver(pcf8574_kp_driver); 208 209 MODULE_AUTHOR("Michael Hennerich"); 210 MODULE_DESCRIPTION("Keypad input driver for 16 keys connected to PCF8574"); 211 MODULE_LICENSE("GPL"); 212