1/* 2 * Copyright (C) 2011 Sony Ericsson Mobile Communications Inc. 3 * 4 * Author: Courtney Cavin <courtney.cavin@sonyericsson.com> 5 * Prepared for up-stream by: Oskar Andero <oskar.andero@sonyericsson.com> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License version 2, as 9 * published by the Free Software Foundation. 10 */ 11 12#include <linux/i2c.h> 13#include <linux/irq.h> 14#include <linux/slab.h> 15#include <linux/input.h> 16#include <linux/module.h> 17#include <linux/interrupt.h> 18#include <linux/gpio.h> 19#include <linux/delay.h> 20#include <linux/input/gp2ap002a00f.h> 21 22struct gp2a_data { 23 struct input_dev *input; 24 const struct gp2a_platform_data *pdata; 25 struct i2c_client *i2c_client; 26}; 27 28enum gp2a_addr { 29 GP2A_ADDR_PROX = 0x0, 30 GP2A_ADDR_GAIN = 0x1, 31 GP2A_ADDR_HYS = 0x2, 32 GP2A_ADDR_CYCLE = 0x3, 33 GP2A_ADDR_OPMOD = 0x4, 34 GP2A_ADDR_CON = 0x6 35}; 36 37enum gp2a_controls { 38 /* Software Shutdown control: 0 = shutdown, 1 = normal operation */ 39 GP2A_CTRL_SSD = 0x01 40}; 41 42static int gp2a_report(struct gp2a_data *dt) 43{ 44 int vo = gpio_get_value(dt->pdata->vout_gpio); 45 46 input_report_switch(dt->input, SW_FRONT_PROXIMITY, !vo); 47 input_sync(dt->input); 48 49 return 0; 50} 51 52static irqreturn_t gp2a_irq(int irq, void *handle) 53{ 54 struct gp2a_data *dt = handle; 55 56 gp2a_report(dt); 57 58 return IRQ_HANDLED; 59} 60 61static int gp2a_enable(struct gp2a_data *dt) 62{ 63 return i2c_smbus_write_byte_data(dt->i2c_client, GP2A_ADDR_OPMOD, 64 GP2A_CTRL_SSD); 65} 66 67static int gp2a_disable(struct gp2a_data *dt) 68{ 69 return i2c_smbus_write_byte_data(dt->i2c_client, GP2A_ADDR_OPMOD, 70 0x00); 71} 72 73static int gp2a_device_open(struct input_dev *dev) 74{ 75 struct gp2a_data *dt = input_get_drvdata(dev); 76 int error; 77 78 error = gp2a_enable(dt); 79 if (error < 0) { 80 dev_err(&dt->i2c_client->dev, 81 "unable to activate, err %d\n", error); 82 return error; 83 } 84 85 gp2a_report(dt); 86 87 return 0; 88} 89 90static void gp2a_device_close(struct input_dev *dev) 91{ 92 struct gp2a_data *dt = input_get_drvdata(dev); 93 int error; 94 95 error = gp2a_disable(dt); 96 if (error < 0) 97 dev_err(&dt->i2c_client->dev, 98 "unable to deactivate, err %d\n", error); 99} 100 101static int gp2a_initialize(struct gp2a_data *dt) 102{ 103 int error; 104 105 error = i2c_smbus_write_byte_data(dt->i2c_client, GP2A_ADDR_GAIN, 106 0x08); 107 if (error < 0) 108 return error; 109 110 error = i2c_smbus_write_byte_data(dt->i2c_client, GP2A_ADDR_HYS, 111 0xc2); 112 if (error < 0) 113 return error; 114 115 error = i2c_smbus_write_byte_data(dt->i2c_client, GP2A_ADDR_CYCLE, 116 0x04); 117 if (error < 0) 118 return error; 119 120 error = gp2a_disable(dt); 121 122 return error; 123} 124 125static int gp2a_probe(struct i2c_client *client, 126 const struct i2c_device_id *id) 127{ 128 const struct gp2a_platform_data *pdata = dev_get_platdata(&client->dev); 129 struct gp2a_data *dt; 130 int error; 131 132 if (!pdata) 133 return -EINVAL; 134 135 if (pdata->hw_setup) { 136 error = pdata->hw_setup(client); 137 if (error < 0) 138 return error; 139 } 140 141 error = gpio_request_one(pdata->vout_gpio, GPIOF_IN, GP2A_I2C_NAME); 142 if (error) 143 goto err_hw_shutdown; 144 145 dt = kzalloc(sizeof(struct gp2a_data), GFP_KERNEL); 146 if (!dt) { 147 error = -ENOMEM; 148 goto err_free_gpio; 149 } 150 151 dt->pdata = pdata; 152 dt->i2c_client = client; 153 154 error = gp2a_initialize(dt); 155 if (error < 0) 156 goto err_free_mem; 157 158 dt->input = input_allocate_device(); 159 if (!dt->input) { 160 error = -ENOMEM; 161 goto err_free_mem; 162 } 163 164 input_set_drvdata(dt->input, dt); 165 166 dt->input->open = gp2a_device_open; 167 dt->input->close = gp2a_device_close; 168 dt->input->name = GP2A_I2C_NAME; 169 dt->input->id.bustype = BUS_I2C; 170 dt->input->dev.parent = &client->dev; 171 172 input_set_capability(dt->input, EV_SW, SW_FRONT_PROXIMITY); 173 174 error = request_threaded_irq(client->irq, NULL, gp2a_irq, 175 IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | 176 IRQF_ONESHOT, 177 GP2A_I2C_NAME, dt); 178 if (error) { 179 dev_err(&client->dev, "irq request failed\n"); 180 goto err_free_input_dev; 181 } 182 183 error = input_register_device(dt->input); 184 if (error) { 185 dev_err(&client->dev, "device registration failed\n"); 186 goto err_free_irq; 187 } 188 189 device_init_wakeup(&client->dev, pdata->wakeup); 190 i2c_set_clientdata(client, dt); 191 192 return 0; 193 194err_free_irq: 195 free_irq(client->irq, dt); 196err_free_input_dev: 197 input_free_device(dt->input); 198err_free_mem: 199 kfree(dt); 200err_free_gpio: 201 gpio_free(pdata->vout_gpio); 202err_hw_shutdown: 203 if (pdata->hw_shutdown) 204 pdata->hw_shutdown(client); 205 return error; 206} 207 208static int gp2a_remove(struct i2c_client *client) 209{ 210 struct gp2a_data *dt = i2c_get_clientdata(client); 211 const struct gp2a_platform_data *pdata = dt->pdata; 212 213 device_init_wakeup(&client->dev, false); 214 215 free_irq(client->irq, dt); 216 217 input_unregister_device(dt->input); 218 kfree(dt); 219 220 gpio_free(pdata->vout_gpio); 221 222 if (pdata->hw_shutdown) 223 pdata->hw_shutdown(client); 224 225 return 0; 226} 227 228static int __maybe_unused gp2a_suspend(struct device *dev) 229{ 230 struct i2c_client *client = to_i2c_client(dev); 231 struct gp2a_data *dt = i2c_get_clientdata(client); 232 int retval = 0; 233 234 if (device_may_wakeup(&client->dev)) { 235 enable_irq_wake(client->irq); 236 } else { 237 mutex_lock(&dt->input->mutex); 238 if (dt->input->users) 239 retval = gp2a_disable(dt); 240 mutex_unlock(&dt->input->mutex); 241 } 242 243 return retval; 244} 245 246static int __maybe_unused gp2a_resume(struct device *dev) 247{ 248 struct i2c_client *client = to_i2c_client(dev); 249 struct gp2a_data *dt = i2c_get_clientdata(client); 250 int retval = 0; 251 252 if (device_may_wakeup(&client->dev)) { 253 disable_irq_wake(client->irq); 254 } else { 255 mutex_lock(&dt->input->mutex); 256 if (dt->input->users) 257 retval = gp2a_enable(dt); 258 mutex_unlock(&dt->input->mutex); 259 } 260 261 return retval; 262} 263 264static SIMPLE_DEV_PM_OPS(gp2a_pm, gp2a_suspend, gp2a_resume); 265 266static const struct i2c_device_id gp2a_i2c_id[] = { 267 { GP2A_I2C_NAME, 0 }, 268 { } 269}; 270MODULE_DEVICE_TABLE(i2c, gp2a_i2c_id); 271 272static struct i2c_driver gp2a_i2c_driver = { 273 .driver = { 274 .name = GP2A_I2C_NAME, 275 .pm = &gp2a_pm, 276 }, 277 .probe = gp2a_probe, 278 .remove = gp2a_remove, 279 .id_table = gp2a_i2c_id, 280}; 281 282module_i2c_driver(gp2a_i2c_driver); 283 284MODULE_AUTHOR("Courtney Cavin <courtney.cavin@sonyericsson.com>"); 285MODULE_DESCRIPTION("Sharp GP2AP002A00F I2C Proximity/Opto sensor driver"); 286MODULE_LICENSE("GPL v2"); 287