]>
Commit | Line | Data |
---|---|---|
ff803ed4 CC |
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 | ||
22 | struct gp2a_data { | |
23 | struct input_dev *input; | |
24 | const struct gp2a_platform_data *pdata; | |
25 | struct i2c_client *i2c_client; | |
26 | }; | |
27 | ||
28 | enum 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 | ||
37 | enum gp2a_controls { | |
38 | /* Software Shutdown control: 0 = shutdown, 1 = normal operation */ | |
39 | GP2A_CTRL_SSD = 0x01 | |
40 | }; | |
41 | ||
42 | static 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 | ||
52 | static 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 | ||
61 | static 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 | ||
67 | static 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 | ||
73 | static 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 | ||
90 | static 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 | ||
5298cc4c | 101 | static int gp2a_initialize(struct gp2a_data *dt) |
ff803ed4 CC |
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 | ||
5298cc4c | 125 | static int gp2a_probe(struct i2c_client *client, |
ff803ed4 CC |
126 | const struct i2c_device_id *id) |
127 | { | |
c838cb3d | 128 | const struct gp2a_platform_data *pdata = dev_get_platdata(&client->dev); |
ff803ed4 CC |
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 | ||
194 | err_free_irq: | |
195 | free_irq(client->irq, dt); | |
196 | err_free_input_dev: | |
197 | input_free_device(dt->input); | |
198 | err_free_mem: | |
199 | kfree(dt); | |
200 | err_free_gpio: | |
201 | gpio_free(pdata->vout_gpio); | |
202 | err_hw_shutdown: | |
203 | if (pdata->hw_shutdown) | |
204 | pdata->hw_shutdown(client); | |
205 | return error; | |
206 | } | |
207 | ||
e2619cf7 | 208 | static int gp2a_remove(struct i2c_client *client) |
ff803ed4 CC |
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 | ||
97a652a8 | 228 | static int __maybe_unused gp2a_suspend(struct device *dev) |
ff803ed4 CC |
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 | ||
97a652a8 | 246 | static int __maybe_unused gp2a_resume(struct device *dev) |
ff803ed4 CC |
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 | } | |
ff803ed4 CC |
263 | |
264 | static SIMPLE_DEV_PM_OPS(gp2a_pm, gp2a_suspend, gp2a_resume); | |
265 | ||
266 | static const struct i2c_device_id gp2a_i2c_id[] = { | |
267 | { GP2A_I2C_NAME, 0 }, | |
268 | { } | |
269 | }; | |
270 | ||
271 | static struct i2c_driver gp2a_i2c_driver = { | |
272 | .driver = { | |
273 | .name = GP2A_I2C_NAME, | |
274 | .owner = THIS_MODULE, | |
275 | .pm = &gp2a_pm, | |
276 | }, | |
277 | .probe = gp2a_probe, | |
1cb0aa88 | 278 | .remove = gp2a_remove, |
ff803ed4 CC |
279 | .id_table = gp2a_i2c_id, |
280 | }; | |
281 | ||
4a533835 | 282 | module_i2c_driver(gp2a_i2c_driver); |
ff803ed4 CC |
283 | |
284 | MODULE_AUTHOR("Courtney Cavin <courtney.cavin@sonyericsson.com>"); | |
285 | MODULE_DESCRIPTION("Sharp GP2AP002A00F I2C Proximity/Opto sensor driver"); | |
286 | MODULE_LICENSE("GPL v2"); |