]>
Commit | Line | Data |
---|---|---|
9d084a3d FM |
1 | /* |
2 | * Copyright (c) 2010, 2011 Fabien Marteau <fabien.marteau@armadeus.com> | |
3 | * Sponsored by ARMadeus Systems | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or modify | |
6 | * it under the terms of the GNU General Public License as published by | |
7 | * the Free Software Foundation; either version 2 of the License, or | |
8 | * (at your option) any later version. | |
9 | * | |
10 | * This program is distributed in the hope that it will be useful, | |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | * GNU General Public License for more details. | |
14 | * | |
15 | * You should have received a copy of the GNU General Public License | |
16 | * along with this program; if not, write to the Free Software | |
17 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
18 | * | |
19 | * Driver for Austria Microsystems joysticks AS5011 | |
20 | * | |
21 | * TODO: | |
22 | * - Power on the chip when open() and power down when close() | |
23 | * - Manage power mode | |
24 | */ | |
25 | ||
26 | #include <linux/i2c.h> | |
27 | #include <linux/interrupt.h> | |
28 | #include <linux/input.h> | |
29 | #include <linux/gpio.h> | |
30 | #include <linux/delay.h> | |
31 | #include <linux/input/as5011.h> | |
32 | #include <linux/slab.h> | |
d2d8442d | 33 | #include <linux/module.h> |
9d084a3d FM |
34 | |
35 | #define DRIVER_DESC "Driver for Austria Microsystems AS5011 joystick" | |
36 | #define MODULE_DEVICE_ALIAS "as5011" | |
37 | ||
38 | MODULE_AUTHOR("Fabien Marteau <fabien.marteau@armadeus.com>"); | |
39 | MODULE_DESCRIPTION(DRIVER_DESC); | |
40 | MODULE_LICENSE("GPL"); | |
41 | ||
42 | /* registers */ | |
43 | #define AS5011_CTRL1 0x76 | |
44 | #define AS5011_CTRL2 0x75 | |
45 | #define AS5011_XP 0x43 | |
46 | #define AS5011_XN 0x44 | |
47 | #define AS5011_YP 0x53 | |
48 | #define AS5011_YN 0x54 | |
49 | #define AS5011_X_REG 0x41 | |
50 | #define AS5011_Y_REG 0x42 | |
51 | #define AS5011_X_RES_INT 0x51 | |
52 | #define AS5011_Y_RES_INT 0x52 | |
53 | ||
54 | /* CTRL1 bits */ | |
55 | #define AS5011_CTRL1_LP_PULSED 0x80 | |
56 | #define AS5011_CTRL1_LP_ACTIVE 0x40 | |
57 | #define AS5011_CTRL1_LP_CONTINUE 0x20 | |
58 | #define AS5011_CTRL1_INT_WUP_EN 0x10 | |
59 | #define AS5011_CTRL1_INT_ACT_EN 0x08 | |
60 | #define AS5011_CTRL1_EXT_CLK_EN 0x04 | |
61 | #define AS5011_CTRL1_SOFT_RST 0x02 | |
62 | #define AS5011_CTRL1_DATA_VALID 0x01 | |
63 | ||
64 | /* CTRL2 bits */ | |
65 | #define AS5011_CTRL2_EXT_SAMPLE_EN 0x08 | |
66 | #define AS5011_CTRL2_RC_BIAS_ON 0x04 | |
67 | #define AS5011_CTRL2_INV_SPINNING 0x02 | |
68 | ||
69 | #define AS5011_MAX_AXIS 80 | |
70 | #define AS5011_MIN_AXIS (-80) | |
71 | #define AS5011_FUZZ 8 | |
72 | #define AS5011_FLAT 40 | |
73 | ||
74 | struct as5011_device { | |
75 | struct input_dev *input_dev; | |
76 | struct i2c_client *i2c_client; | |
77 | unsigned int button_gpio; | |
78 | unsigned int button_irq; | |
79 | unsigned int axis_irq; | |
80 | }; | |
81 | ||
82 | static int as5011_i2c_write(struct i2c_client *client, | |
83 | uint8_t aregaddr, | |
84 | uint8_t avalue) | |
85 | { | |
86 | uint8_t data[2] = { aregaddr, avalue }; | |
87 | struct i2c_msg msg = { | |
88 | client->addr, I2C_M_IGNORE_NAK, 2, (uint8_t *)data | |
89 | }; | |
90 | int error; | |
91 | ||
92 | error = i2c_transfer(client->adapter, &msg, 1); | |
93 | return error < 0 ? error : 0; | |
94 | } | |
95 | ||
96 | static int as5011_i2c_read(struct i2c_client *client, | |
97 | uint8_t aregaddr, signed char *value) | |
98 | { | |
99 | uint8_t data[2] = { aregaddr }; | |
100 | struct i2c_msg msg_set[2] = { | |
101 | { client->addr, I2C_M_REV_DIR_ADDR, 1, (uint8_t *)data }, | |
102 | { client->addr, I2C_M_RD | I2C_M_NOSTART, 1, (uint8_t *)data } | |
103 | }; | |
104 | int error; | |
105 | ||
106 | error = i2c_transfer(client->adapter, msg_set, 2); | |
107 | if (error < 0) | |
108 | return error; | |
109 | ||
110 | *value = data[0] & 0x80 ? -1 * (1 + ~data[0]) : data[0]; | |
111 | return 0; | |
112 | } | |
113 | ||
114 | static irqreturn_t as5011_button_interrupt(int irq, void *dev_id) | |
115 | { | |
116 | struct as5011_device *as5011 = dev_id; | |
117 | int val = gpio_get_value_cansleep(as5011->button_gpio); | |
118 | ||
119 | input_report_key(as5011->input_dev, BTN_JOYSTICK, !val); | |
120 | input_sync(as5011->input_dev); | |
121 | ||
122 | return IRQ_HANDLED; | |
123 | } | |
124 | ||
125 | static irqreturn_t as5011_axis_interrupt(int irq, void *dev_id) | |
126 | { | |
127 | struct as5011_device *as5011 = dev_id; | |
128 | int error; | |
129 | signed char x, y; | |
130 | ||
131 | error = as5011_i2c_read(as5011->i2c_client, AS5011_X_RES_INT, &x); | |
132 | if (error < 0) | |
133 | goto out; | |
134 | ||
135 | error = as5011_i2c_read(as5011->i2c_client, AS5011_Y_RES_INT, &y); | |
136 | if (error < 0) | |
137 | goto out; | |
138 | ||
139 | input_report_abs(as5011->input_dev, ABS_X, x); | |
140 | input_report_abs(as5011->input_dev, ABS_Y, y); | |
141 | input_sync(as5011->input_dev); | |
142 | ||
143 | out: | |
144 | return IRQ_HANDLED; | |
145 | } | |
146 | ||
147 | static int __devinit as5011_configure_chip(struct as5011_device *as5011, | |
148 | const struct as5011_platform_data *plat_dat) | |
149 | { | |
150 | struct i2c_client *client = as5011->i2c_client; | |
151 | int error; | |
152 | signed char value; | |
153 | ||
154 | /* chip soft reset */ | |
155 | error = as5011_i2c_write(client, AS5011_CTRL1, | |
156 | AS5011_CTRL1_SOFT_RST); | |
157 | if (error < 0) { | |
158 | dev_err(&client->dev, "Soft reset failed\n"); | |
159 | return error; | |
160 | } | |
161 | ||
162 | mdelay(10); | |
163 | ||
164 | error = as5011_i2c_write(client, AS5011_CTRL1, | |
165 | AS5011_CTRL1_LP_PULSED | | |
166 | AS5011_CTRL1_LP_ACTIVE | | |
167 | AS5011_CTRL1_INT_ACT_EN); | |
168 | if (error < 0) { | |
169 | dev_err(&client->dev, "Power config failed\n"); | |
170 | return error; | |
171 | } | |
172 | ||
173 | error = as5011_i2c_write(client, AS5011_CTRL2, | |
174 | AS5011_CTRL2_INV_SPINNING); | |
175 | if (error < 0) { | |
176 | dev_err(&client->dev, "Can't invert spinning\n"); | |
177 | return error; | |
178 | } | |
179 | ||
180 | /* write threshold */ | |
181 | error = as5011_i2c_write(client, AS5011_XP, plat_dat->xp); | |
182 | if (error < 0) { | |
183 | dev_err(&client->dev, "Can't write threshold\n"); | |
184 | return error; | |
185 | } | |
186 | ||
187 | error = as5011_i2c_write(client, AS5011_XN, plat_dat->xn); | |
188 | if (error < 0) { | |
189 | dev_err(&client->dev, "Can't write threshold\n"); | |
190 | return error; | |
191 | } | |
192 | ||
193 | error = as5011_i2c_write(client, AS5011_YP, plat_dat->yp); | |
194 | if (error < 0) { | |
195 | dev_err(&client->dev, "Can't write threshold\n"); | |
196 | return error; | |
197 | } | |
198 | ||
199 | error = as5011_i2c_write(client, AS5011_YN, plat_dat->yn); | |
200 | if (error < 0) { | |
201 | dev_err(&client->dev, "Can't write threshold\n"); | |
202 | return error; | |
203 | } | |
204 | ||
205 | /* to free irq gpio in chip */ | |
206 | error = as5011_i2c_read(client, AS5011_X_RES_INT, &value); | |
207 | if (error < 0) { | |
208 | dev_err(&client->dev, "Can't read i2c X resolution value\n"); | |
209 | return error; | |
210 | } | |
211 | ||
212 | return 0; | |
213 | } | |
214 | ||
215 | static int __devinit as5011_probe(struct i2c_client *client, | |
216 | const struct i2c_device_id *id) | |
217 | { | |
218 | const struct as5011_platform_data *plat_data; | |
219 | struct as5011_device *as5011; | |
220 | struct input_dev *input_dev; | |
221 | int irq; | |
222 | int error; | |
223 | ||
224 | plat_data = client->dev.platform_data; | |
225 | if (!plat_data) | |
226 | return -EINVAL; | |
227 | ||
228 | if (!plat_data->axis_irq) { | |
229 | dev_err(&client->dev, "No axis IRQ?\n"); | |
230 | return -EINVAL; | |
231 | } | |
232 | ||
233 | if (!i2c_check_functionality(client->adapter, | |
14674e70 | 234 | I2C_FUNC_NOSTART | |
9d084a3d FM |
235 | I2C_FUNC_PROTOCOL_MANGLING)) { |
236 | dev_err(&client->dev, | |
237 | "need i2c bus that supports protocol mangling\n"); | |
238 | return -ENODEV; | |
239 | } | |
240 | ||
241 | as5011 = kmalloc(sizeof(struct as5011_device), GFP_KERNEL); | |
242 | input_dev = input_allocate_device(); | |
243 | if (!as5011 || !input_dev) { | |
244 | dev_err(&client->dev, | |
245 | "Can't allocate memory for device structure\n"); | |
246 | error = -ENOMEM; | |
247 | goto err_free_mem; | |
248 | } | |
249 | ||
250 | as5011->i2c_client = client; | |
251 | as5011->input_dev = input_dev; | |
252 | as5011->button_gpio = plat_data->button_gpio; | |
253 | as5011->axis_irq = plat_data->axis_irq; | |
254 | ||
255 | input_dev->name = "Austria Microsystem as5011 joystick"; | |
256 | input_dev->id.bustype = BUS_I2C; | |
257 | input_dev->dev.parent = &client->dev; | |
258 | ||
259 | __set_bit(EV_KEY, input_dev->evbit); | |
260 | __set_bit(EV_ABS, input_dev->evbit); | |
261 | __set_bit(BTN_JOYSTICK, input_dev->keybit); | |
262 | ||
263 | input_set_abs_params(input_dev, ABS_X, | |
264 | AS5011_MIN_AXIS, AS5011_MAX_AXIS, AS5011_FUZZ, AS5011_FLAT); | |
265 | input_set_abs_params(as5011->input_dev, ABS_Y, | |
266 | AS5011_MIN_AXIS, AS5011_MAX_AXIS, AS5011_FUZZ, AS5011_FLAT); | |
267 | ||
268 | error = gpio_request(as5011->button_gpio, "AS5011 button"); | |
269 | if (error < 0) { | |
270 | dev_err(&client->dev, "Failed to request button gpio\n"); | |
271 | goto err_free_mem; | |
272 | } | |
273 | ||
274 | irq = gpio_to_irq(as5011->button_gpio); | |
275 | if (irq < 0) { | |
276 | dev_err(&client->dev, | |
277 | "Failed to get irq number for button gpio\n"); | |
278 | goto err_free_button_gpio; | |
279 | } | |
280 | ||
281 | as5011->button_irq = irq; | |
282 | ||
283 | error = request_threaded_irq(as5011->button_irq, | |
284 | NULL, as5011_button_interrupt, | |
9b7e31bb LPC |
285 | IRQF_TRIGGER_RISING | |
286 | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, | |
9d084a3d FM |
287 | "as5011_button", as5011); |
288 | if (error < 0) { | |
289 | dev_err(&client->dev, | |
290 | "Can't allocate button irq %d\n", as5011->button_irq); | |
291 | goto err_free_button_gpio; | |
292 | } | |
293 | ||
294 | error = as5011_configure_chip(as5011, plat_data); | |
295 | if (error) | |
296 | goto err_free_button_irq; | |
297 | ||
298 | error = request_threaded_irq(as5011->axis_irq, NULL, | |
299 | as5011_axis_interrupt, | |
9b7e31bb | 300 | plat_data->axis_irqflags | IRQF_ONESHOT, |
9d084a3d FM |
301 | "as5011_joystick", as5011); |
302 | if (error) { | |
303 | dev_err(&client->dev, | |
304 | "Can't allocate axis irq %d\n", plat_data->axis_irq); | |
305 | goto err_free_button_irq; | |
306 | } | |
307 | ||
308 | error = input_register_device(as5011->input_dev); | |
309 | if (error) { | |
310 | dev_err(&client->dev, "Failed to register input device\n"); | |
311 | goto err_free_axis_irq; | |
312 | } | |
313 | ||
314 | i2c_set_clientdata(client, as5011); | |
315 | ||
316 | return 0; | |
317 | ||
318 | err_free_axis_irq: | |
319 | free_irq(as5011->axis_irq, as5011); | |
320 | err_free_button_irq: | |
321 | free_irq(as5011->button_irq, as5011); | |
322 | err_free_button_gpio: | |
323 | gpio_free(as5011->button_gpio); | |
324 | err_free_mem: | |
325 | input_free_device(input_dev); | |
326 | kfree(as5011); | |
327 | ||
328 | return error; | |
329 | } | |
330 | ||
331 | static int __devexit as5011_remove(struct i2c_client *client) | |
332 | { | |
333 | struct as5011_device *as5011 = i2c_get_clientdata(client); | |
334 | ||
335 | free_irq(as5011->axis_irq, as5011); | |
336 | free_irq(as5011->button_irq, as5011); | |
337 | gpio_free(as5011->button_gpio); | |
338 | ||
339 | input_unregister_device(as5011->input_dev); | |
340 | kfree(as5011); | |
341 | ||
342 | return 0; | |
343 | } | |
344 | ||
345 | static const struct i2c_device_id as5011_id[] = { | |
346 | { MODULE_DEVICE_ALIAS, 0 }, | |
347 | { } | |
348 | }; | |
349 | MODULE_DEVICE_TABLE(i2c, as5011_id); | |
350 | ||
351 | static struct i2c_driver as5011_driver = { | |
352 | .driver = { | |
353 | .name = "as5011", | |
354 | }, | |
355 | .probe = as5011_probe, | |
356 | .remove = __devexit_p(as5011_remove), | |
357 | .id_table = as5011_id, | |
358 | }; | |
359 | ||
1b92c1cf | 360 | module_i2c_driver(as5011_driver); |