2 * Copyright (C) 2011 Sony Ericsson Mobile Communications Inc.
4 * Author: Courtney Cavin <courtney.cavin@sonyericsson.com>
5 * Prepared for up-stream by: Oskar Andero <oskar.andero@sonyericsson.com>
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.
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>
23 struct input_dev *input;
24 const struct gp2a_platform_data *pdata;
25 struct i2c_client *i2c_client;
32 GP2A_ADDR_CYCLE = 0x3,
33 GP2A_ADDR_OPMOD = 0x4,
38 /* Software Shutdown control: 0 = shutdown, 1 = normal operation */
42 static int gp2a_report(struct gp2a_data *dt)
44 int vo = gpio_get_value(dt->pdata->vout_gpio);
46 input_report_switch(dt->input, SW_FRONT_PROXIMITY, !vo);
47 input_sync(dt->input);
52 static irqreturn_t gp2a_irq(int irq, void *handle)
54 struct gp2a_data *dt = handle;
61 static int gp2a_enable(struct gp2a_data *dt)
63 return i2c_smbus_write_byte_data(dt->i2c_client, GP2A_ADDR_OPMOD,
67 static int gp2a_disable(struct gp2a_data *dt)
69 return i2c_smbus_write_byte_data(dt->i2c_client, GP2A_ADDR_OPMOD,
73 static int gp2a_device_open(struct input_dev *dev)
75 struct gp2a_data *dt = input_get_drvdata(dev);
78 error = gp2a_enable(dt);
80 dev_err(&dt->i2c_client->dev,
81 "unable to activate, err %d\n", error);
90 static void gp2a_device_close(struct input_dev *dev)
92 struct gp2a_data *dt = input_get_drvdata(dev);
95 error = gp2a_disable(dt);
97 dev_err(&dt->i2c_client->dev,
98 "unable to deactivate, err %d\n", error);
101 static int gp2a_initialize(struct gp2a_data *dt)
105 error = i2c_smbus_write_byte_data(dt->i2c_client, GP2A_ADDR_GAIN,
110 error = i2c_smbus_write_byte_data(dt->i2c_client, GP2A_ADDR_HYS,
115 error = i2c_smbus_write_byte_data(dt->i2c_client, GP2A_ADDR_CYCLE,
120 error = gp2a_disable(dt);
125 static int gp2a_probe(struct i2c_client *client,
126 const struct i2c_device_id *id)
128 const struct gp2a_platform_data *pdata = dev_get_platdata(&client->dev);
129 struct gp2a_data *dt;
135 if (pdata->hw_setup) {
136 error = pdata->hw_setup(client);
141 error = gpio_request_one(pdata->vout_gpio, GPIOF_IN, GP2A_I2C_NAME);
143 goto err_hw_shutdown;
145 dt = kzalloc(sizeof(struct gp2a_data), GFP_KERNEL);
152 dt->i2c_client = client;
154 error = gp2a_initialize(dt);
158 dt->input = input_allocate_device();
164 input_set_drvdata(dt->input, dt);
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;
172 input_set_capability(dt->input, EV_SW, SW_FRONT_PROXIMITY);
174 error = request_threaded_irq(client->irq, NULL, gp2a_irq,
175 IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
179 dev_err(&client->dev, "irq request failed\n");
180 goto err_free_input_dev;
183 error = input_register_device(dt->input);
185 dev_err(&client->dev, "device registration failed\n");
189 device_init_wakeup(&client->dev, pdata->wakeup);
190 i2c_set_clientdata(client, dt);
195 free_irq(client->irq, dt);
197 input_free_device(dt->input);
201 gpio_free(pdata->vout_gpio);
203 if (pdata->hw_shutdown)
204 pdata->hw_shutdown(client);
208 static int gp2a_remove(struct i2c_client *client)
210 struct gp2a_data *dt = i2c_get_clientdata(client);
211 const struct gp2a_platform_data *pdata = dt->pdata;
213 device_init_wakeup(&client->dev, false);
215 free_irq(client->irq, dt);
217 input_unregister_device(dt->input);
220 gpio_free(pdata->vout_gpio);
222 if (pdata->hw_shutdown)
223 pdata->hw_shutdown(client);
228 #ifdef CONFIG_PM_SLEEP
229 static int gp2a_suspend(struct device *dev)
231 struct i2c_client *client = to_i2c_client(dev);
232 struct gp2a_data *dt = i2c_get_clientdata(client);
235 if (device_may_wakeup(&client->dev)) {
236 enable_irq_wake(client->irq);
238 mutex_lock(&dt->input->mutex);
239 if (dt->input->users)
240 retval = gp2a_disable(dt);
241 mutex_unlock(&dt->input->mutex);
247 static int gp2a_resume(struct device *dev)
249 struct i2c_client *client = to_i2c_client(dev);
250 struct gp2a_data *dt = i2c_get_clientdata(client);
253 if (device_may_wakeup(&client->dev)) {
254 disable_irq_wake(client->irq);
256 mutex_lock(&dt->input->mutex);
257 if (dt->input->users)
258 retval = gp2a_enable(dt);
259 mutex_unlock(&dt->input->mutex);
266 static SIMPLE_DEV_PM_OPS(gp2a_pm, gp2a_suspend, gp2a_resume);
268 static const struct i2c_device_id gp2a_i2c_id[] = {
269 { GP2A_I2C_NAME, 0 },
273 static struct i2c_driver gp2a_i2c_driver = {
275 .name = GP2A_I2C_NAME,
276 .owner = THIS_MODULE,
280 .remove = gp2a_remove,
281 .id_table = gp2a_i2c_id,
284 module_i2c_driver(gp2a_i2c_driver);
286 MODULE_AUTHOR("Courtney Cavin <courtney.cavin@sonyericsson.com>");
287 MODULE_DESCRIPTION("Sharp GP2AP002A00F I2C Proximity/Opto sensor driver");
288 MODULE_LICENSE("GPL v2");