blob: 09902f4efc5ea211af95dd1bb8a05d5c5edb34ec [file] [log] [blame]
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001/*
2 * KXCJK-1013 3-axis accelerometer driver
3 * Copyright (c) 2014, Intel Corporation.
4 *
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms and conditions of the GNU General Public License,
7 * version 2, as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 */
14
15#include <linux/module.h>
16#include <linux/i2c.h>
17#include <linux/interrupt.h>
18#include <linux/delay.h>
19#include <linux/bitops.h>
20#include <linux/slab.h>
21#include <linux/string.h>
22#include <linux/acpi.h>
23#include <linux/gpio/consumer.h>
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +010024#include <linux/pm.h>
25#include <linux/pm_runtime.h>
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +000026#include <linux/iio/iio.h>
27#include <linux/iio/sysfs.h>
28#include <linux/iio/buffer.h>
29#include <linux/iio/trigger.h>
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +010030#include <linux/iio/events.h>
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +000031#include <linux/iio/trigger_consumer.h>
32#include <linux/iio/triggered_buffer.h>
33#include <linux/iio/accel/kxcjk_1013.h>
34
35#define KXCJK1013_DRV_NAME "kxcjk1013"
36#define KXCJK1013_IRQ_NAME "kxcjk1013_event"
37
38#define KXCJK1013_REG_XOUT_L 0x06
39/*
40 * From low byte X axis register, all the other addresses of Y and Z can be
41 * obtained by just applying axis offset. The following axis defines are just
42 * provide clarity, but not used.
43 */
44#define KXCJK1013_REG_XOUT_H 0x07
45#define KXCJK1013_REG_YOUT_L 0x08
46#define KXCJK1013_REG_YOUT_H 0x09
47#define KXCJK1013_REG_ZOUT_L 0x0A
48#define KXCJK1013_REG_ZOUT_H 0x0B
49
50#define KXCJK1013_REG_DCST_RESP 0x0C
51#define KXCJK1013_REG_WHO_AM_I 0x0F
52#define KXCJK1013_REG_INT_SRC1 0x16
53#define KXCJK1013_REG_INT_SRC2 0x17
54#define KXCJK1013_REG_STATUS_REG 0x18
55#define KXCJK1013_REG_INT_REL 0x1A
56#define KXCJK1013_REG_CTRL1 0x1B
57#define KXCJK1013_REG_CTRL2 0x1D
58#define KXCJK1013_REG_INT_CTRL1 0x1E
59#define KXCJK1013_REG_INT_CTRL2 0x1F
60#define KXCJK1013_REG_DATA_CTRL 0x21
61#define KXCJK1013_REG_WAKE_TIMER 0x29
62#define KXCJK1013_REG_SELF_TEST 0x3A
63#define KXCJK1013_REG_WAKE_THRES 0x6A
64
65#define KXCJK1013_REG_CTRL1_BIT_PC1 BIT(7)
66#define KXCJK1013_REG_CTRL1_BIT_RES BIT(6)
67#define KXCJK1013_REG_CTRL1_BIT_DRDY BIT(5)
68#define KXCJK1013_REG_CTRL1_BIT_GSEL1 BIT(4)
69#define KXCJK1013_REG_CTRL1_BIT_GSEL0 BIT(3)
70#define KXCJK1013_REG_CTRL1_BIT_WUFE BIT(1)
71#define KXCJK1013_REG_INT_REG1_BIT_IEA BIT(4)
72#define KXCJK1013_REG_INT_REG1_BIT_IEN BIT(5)
73
74#define KXCJK1013_DATA_MASK_12_BIT 0x0FFF
75#define KXCJK1013_MAX_STARTUP_TIME_US 100000
76
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +010077#define KXCJK1013_SLEEP_DELAY_MS 2000
78
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +010079#define KXCJK1013_REG_INT_SRC2_BIT_ZP BIT(0)
80#define KXCJK1013_REG_INT_SRC2_BIT_ZN BIT(1)
81#define KXCJK1013_REG_INT_SRC2_BIT_YP BIT(2)
82#define KXCJK1013_REG_INT_SRC2_BIT_YN BIT(3)
83#define KXCJK1013_REG_INT_SRC2_BIT_XP BIT(4)
84#define KXCJK1013_REG_INT_SRC2_BIT_XN BIT(5)
85
86#define KXCJK1013_DEFAULT_WAKE_THRES 1
87
Daniel Balutac6861372014-03-09 08:33:00 +000088enum kx_chipset {
89 KXCJK1013,
90 KXCJ91008,
91 KXTJ21009,
92 KX_MAX_CHIPS /* this must be last */
93};
94
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +000095struct kxcjk1013_data {
96 struct i2c_client *client;
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +010097 struct iio_trigger *dready_trig;
98 struct iio_trigger *motion_trig;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +000099 struct mutex mutex;
100 s16 buffer[8];
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000101 u8 odr_bits;
Srinivas Pandruvadaa735e3d2014-05-08 22:58:00 +0100102 u8 range;
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100103 int wake_thres;
104 int wake_dur;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000105 bool active_high_intr;
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100106 bool dready_trigger_on;
107 int ev_enable_state;
108 bool motion_trigger_on;
109 int64_t timestamp;
Daniel Balutac6861372014-03-09 08:33:00 +0000110 enum kx_chipset chipset;
Bastien Nocera3bfa74f2014-05-11 22:09:00 +0100111 bool is_smo8500_device;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000112};
113
114enum kxcjk1013_axis {
115 AXIS_X,
116 AXIS_Y,
117 AXIS_Z,
118};
119
120enum kxcjk1013_mode {
121 STANDBY,
122 OPERATION,
123};
124
Srinivas Pandruvadaa735e3d2014-05-08 22:58:00 +0100125enum kxcjk1013_range {
126 KXCJK1013_RANGE_2G,
127 KXCJK1013_RANGE_4G,
128 KXCJK1013_RANGE_8G,
129};
130
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000131static const struct {
132 int val;
133 int val2;
134 int odr_bits;
135} samp_freq_table[] = { {0, 781000, 0x08}, {1, 563000, 0x09},
Srinivas Pandruvadaf0ca9742014-07-17 01:42:00 +0100136 {3, 125000, 0x0A}, {6, 250000, 0x0B}, {12, 500000, 0},
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000137 {25, 0, 0x01}, {50, 0, 0x02}, {100, 0, 0x03},
138 {200, 0, 0x04}, {400, 0, 0x05}, {800, 0, 0x06},
139 {1600, 0, 0x07} };
140
141/* Refer to section 4 of the specification */
142static const struct {
143 int odr_bits;
144 int usec;
Daniel Balutac6861372014-03-09 08:33:00 +0000145} odr_start_up_times[KX_MAX_CHIPS][12] = {
146 /* KXCJK-1013 */
147 {
148 {0x08, 100000},
149 {0x09, 100000},
150 {0x0A, 100000},
151 {0x0B, 100000},
152 {0, 80000},
153 {0x01, 41000},
154 {0x02, 21000},
155 {0x03, 11000},
156 {0x04, 6400},
157 {0x05, 3900},
158 {0x06, 2700},
159 {0x07, 2100},
160 },
161 /* KXCJ9-1008 */
162 {
163 {0x08, 100000},
164 {0x09, 100000},
165 {0x0A, 100000},
166 {0x0B, 100000},
167 {0, 80000},
168 {0x01, 41000},
169 {0x02, 21000},
170 {0x03, 11000},
171 {0x04, 6400},
172 {0x05, 3900},
173 {0x06, 2700},
174 {0x07, 2100},
175 },
176 /* KXCTJ2-1009 */
177 {
178 {0x08, 1240000},
179 {0x09, 621000},
180 {0x0A, 309000},
181 {0x0B, 151000},
182 {0, 80000},
183 {0x01, 41000},
184 {0x02, 21000},
185 {0x03, 11000},
186 {0x04, 6000},
187 {0x05, 4000},
188 {0x06, 3000},
189 {0x07, 2000},
190 },
191};
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000192
Srinivas Pandruvadaa735e3d2014-05-08 22:58:00 +0100193static const struct {
194 u16 scale;
195 u8 gsel_0;
196 u8 gsel_1;
197} KXCJK1013_scale_table[] = { {9582, 0, 0},
198 {19163, 1, 0},
199 {38326, 0, 1} };
200
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100201static const struct {
202 int val;
203 int val2;
204 int odr_bits;
205} wake_odr_data_rate_table[] = { {0, 781000, 0x00},
206 {1, 563000, 0x01},
207 {3, 125000, 0x02},
208 {6, 250000, 0x03},
209 {12, 500000, 0x04},
210 {25, 0, 0x05},
211 {50, 0, 0x06},
212 {100, 0, 0x06},
213 {200, 0, 0x06},
214 {400, 0, 0x06},
215 {800, 0, 0x06},
216 {1600, 0, 0x06} };
217
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000218static int kxcjk1013_set_mode(struct kxcjk1013_data *data,
219 enum kxcjk1013_mode mode)
220{
221 int ret;
222
223 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
224 if (ret < 0) {
225 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
226 return ret;
227 }
228
229 if (mode == STANDBY)
230 ret &= ~KXCJK1013_REG_CTRL1_BIT_PC1;
231 else
232 ret |= KXCJK1013_REG_CTRL1_BIT_PC1;
233
234 ret = i2c_smbus_write_byte_data(data->client,
235 KXCJK1013_REG_CTRL1, ret);
236 if (ret < 0) {
237 dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
238 return ret;
239 }
240
241 return 0;
242}
243
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100244static int kxcjk1013_get_mode(struct kxcjk1013_data *data,
245 enum kxcjk1013_mode *mode)
246{
247 int ret;
248
249 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
250 if (ret < 0) {
251 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
252 return ret;
253 }
254
255 if (ret & KXCJK1013_REG_CTRL1_BIT_PC1)
256 *mode = OPERATION;
257 else
258 *mode = STANDBY;
259
260 return 0;
261}
262
Srinivas Pandruvadaa735e3d2014-05-08 22:58:00 +0100263static int kxcjk1013_set_range(struct kxcjk1013_data *data, int range_index)
264{
265 int ret;
266
267 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
268 if (ret < 0) {
269 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
270 return ret;
271 }
272
273 ret |= (KXCJK1013_scale_table[range_index].gsel_0 << 3);
274 ret |= (KXCJK1013_scale_table[range_index].gsel_1 << 4);
275
276 ret = i2c_smbus_write_byte_data(data->client,
277 KXCJK1013_REG_CTRL1,
278 ret);
279 if (ret < 0) {
280 dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
281 return ret;
282 }
283
284 data->range = range_index;
285
286 return 0;
287}
288
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000289static int kxcjk1013_chip_init(struct kxcjk1013_data *data)
290{
291 int ret;
292
293 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_WHO_AM_I);
294 if (ret < 0) {
295 dev_err(&data->client->dev, "Error reading who_am_i\n");
296 return ret;
297 }
298
299 dev_dbg(&data->client->dev, "KXCJK1013 Chip Id %x\n", ret);
300
301 ret = kxcjk1013_set_mode(data, STANDBY);
302 if (ret < 0)
303 return ret;
304
305 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
306 if (ret < 0) {
307 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
308 return ret;
309 }
310
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000311 /* Set 12 bit mode */
312 ret |= KXCJK1013_REG_CTRL1_BIT_RES;
313
314 ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_CTRL1,
315 ret);
316 if (ret < 0) {
317 dev_err(&data->client->dev, "Error reading reg_ctrl\n");
318 return ret;
319 }
320
Srinivas Pandruvadaa735e3d2014-05-08 22:58:00 +0100321 /* Setting range to 4G */
322 ret = kxcjk1013_set_range(data, KXCJK1013_RANGE_4G);
323 if (ret < 0)
324 return ret;
325
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000326 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_DATA_CTRL);
327 if (ret < 0) {
328 dev_err(&data->client->dev, "Error reading reg_data_ctrl\n");
329 return ret;
330 }
331
332 data->odr_bits = ret;
333
334 /* Set up INT polarity */
335 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_CTRL1);
336 if (ret < 0) {
337 dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n");
338 return ret;
339 }
340
341 if (data->active_high_intr)
342 ret |= KXCJK1013_REG_INT_REG1_BIT_IEA;
343 else
344 ret &= ~KXCJK1013_REG_INT_REG1_BIT_IEA;
345
346 ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_INT_CTRL1,
347 ret);
348 if (ret < 0) {
349 dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n");
350 return ret;
351 }
352
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100353 ret = kxcjk1013_set_mode(data, OPERATION);
354 if (ret < 0)
355 return ret;
356
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100357 data->wake_thres = KXCJK1013_DEFAULT_WAKE_THRES;
358
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100359 return 0;
360}
361
Daniel Balutac9bf2372014-03-09 16:13:00 +0000362#ifdef CONFIG_PM_RUNTIME
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100363static int kxcjk1013_get_startup_times(struct kxcjk1013_data *data)
364{
365 int i;
Daniel Balutac6861372014-03-09 08:33:00 +0000366 int idx = data->chipset;
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100367
Daniel Balutac6861372014-03-09 08:33:00 +0000368 for (i = 0; i < ARRAY_SIZE(odr_start_up_times[idx]); ++i) {
369 if (odr_start_up_times[idx][i].odr_bits == data->odr_bits)
370 return odr_start_up_times[idx][i].usec;
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100371 }
372
373 return KXCJK1013_MAX_STARTUP_TIME_US;
374}
Daniel Balutac9bf2372014-03-09 16:13:00 +0000375#endif
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100376
377static int kxcjk1013_set_power_state(struct kxcjk1013_data *data, bool on)
378{
Irina Tirdeac75b8dc2014-12-06 00:18:08 +0200379#ifdef CONFIG_PM
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100380 int ret;
381
382 if (on)
383 ret = pm_runtime_get_sync(&data->client->dev);
384 else {
385 pm_runtime_mark_last_busy(&data->client->dev);
386 ret = pm_runtime_put_autosuspend(&data->client->dev);
387 }
388 if (ret < 0) {
389 dev_err(&data->client->dev,
390 "Failed: kxcjk1013_set_power_state for %d\n", on);
Irina Tirdeafbd123e2014-12-10 18:23:53 +0200391 if (on)
392 pm_runtime_put_noidle(&data->client->dev);
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100393 return ret;
394 }
Irina Tirdeac75b8dc2014-12-06 00:18:08 +0200395#endif
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100396
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000397 return 0;
398}
399
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100400static int kxcjk1013_chip_update_thresholds(struct kxcjk1013_data *data)
401{
402 int ret;
403
404 ret = i2c_smbus_write_byte_data(data->client,
405 KXCJK1013_REG_WAKE_TIMER,
406 data->wake_dur);
407 if (ret < 0) {
408 dev_err(&data->client->dev,
409 "Error writing reg_wake_timer\n");
410 return ret;
411 }
412
413 ret = i2c_smbus_write_byte_data(data->client,
414 KXCJK1013_REG_WAKE_THRES,
415 data->wake_thres);
416 if (ret < 0) {
417 dev_err(&data->client->dev, "Error writing reg_wake_thres\n");
418 return ret;
419 }
420
421 return 0;
422}
423
424static int kxcjk1013_setup_any_motion_interrupt(struct kxcjk1013_data *data,
425 bool status)
426{
427 int ret;
428 enum kxcjk1013_mode store_mode;
429
430 ret = kxcjk1013_get_mode(data, &store_mode);
431 if (ret < 0)
432 return ret;
433
434 /* This is requirement by spec to change state to STANDBY */
435 ret = kxcjk1013_set_mode(data, STANDBY);
436 if (ret < 0)
437 return ret;
438
439 ret = kxcjk1013_chip_update_thresholds(data);
440 if (ret < 0)
441 return ret;
442
443 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_CTRL1);
444 if (ret < 0) {
445 dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n");
446 return ret;
447 }
448
449 if (status)
450 ret |= KXCJK1013_REG_INT_REG1_BIT_IEN;
451 else
452 ret &= ~KXCJK1013_REG_INT_REG1_BIT_IEN;
453
454 ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_INT_CTRL1,
455 ret);
456 if (ret < 0) {
457 dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n");
458 return ret;
459 }
460
461 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
462 if (ret < 0) {
463 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
464 return ret;
465 }
466
467 if (status)
468 ret |= KXCJK1013_REG_CTRL1_BIT_WUFE;
469 else
470 ret &= ~KXCJK1013_REG_CTRL1_BIT_WUFE;
471
472 ret = i2c_smbus_write_byte_data(data->client,
473 KXCJK1013_REG_CTRL1, ret);
474 if (ret < 0) {
475 dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
476 return ret;
477 }
478
479 if (store_mode == OPERATION) {
480 ret = kxcjk1013_set_mode(data, OPERATION);
481 if (ret < 0)
482 return ret;
483 }
484
485 return 0;
486}
487
488static int kxcjk1013_setup_new_data_interrupt(struct kxcjk1013_data *data,
489 bool status)
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000490{
491 int ret;
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100492 enum kxcjk1013_mode store_mode;
493
494 ret = kxcjk1013_get_mode(data, &store_mode);
495 if (ret < 0)
496 return ret;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000497
498 /* This is requirement by spec to change state to STANDBY */
499 ret = kxcjk1013_set_mode(data, STANDBY);
500 if (ret < 0)
501 return ret;
502
503 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_CTRL1);
504 if (ret < 0) {
505 dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n");
506 return ret;
507 }
508
509 if (status)
510 ret |= KXCJK1013_REG_INT_REG1_BIT_IEN;
511 else
512 ret &= ~KXCJK1013_REG_INT_REG1_BIT_IEN;
513
514 ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_INT_CTRL1,
515 ret);
516 if (ret < 0) {
517 dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n");
518 return ret;
519 }
520
521 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1);
522 if (ret < 0) {
523 dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
524 return ret;
525 }
526
527 if (status)
528 ret |= KXCJK1013_REG_CTRL1_BIT_DRDY;
529 else
530 ret &= ~KXCJK1013_REG_CTRL1_BIT_DRDY;
531
532 ret = i2c_smbus_write_byte_data(data->client,
533 KXCJK1013_REG_CTRL1, ret);
534 if (ret < 0) {
535 dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
536 return ret;
537 }
538
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100539 if (store_mode == OPERATION) {
540 ret = kxcjk1013_set_mode(data, OPERATION);
541 if (ret < 0)
542 return ret;
543 }
544
545 return 0;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000546}
547
548static int kxcjk1013_convert_freq_to_bit(int val, int val2)
549{
550 int i;
551
552 for (i = 0; i < ARRAY_SIZE(samp_freq_table); ++i) {
553 if (samp_freq_table[i].val == val &&
554 samp_freq_table[i].val2 == val2) {
555 return samp_freq_table[i].odr_bits;
556 }
557 }
558
559 return -EINVAL;
560}
561
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100562static int kxcjk1013_convert_wake_odr_to_bit(int val, int val2)
563{
564 int i;
565
566 for (i = 0; i < ARRAY_SIZE(wake_odr_data_rate_table); ++i) {
567 if (wake_odr_data_rate_table[i].val == val &&
568 wake_odr_data_rate_table[i].val2 == val2) {
569 return wake_odr_data_rate_table[i].odr_bits;
570 }
571 }
572
573 return -EINVAL;
574}
575
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000576static int kxcjk1013_set_odr(struct kxcjk1013_data *data, int val, int val2)
577{
578 int ret;
579 int odr_bits;
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100580 enum kxcjk1013_mode store_mode;
581
582 ret = kxcjk1013_get_mode(data, &store_mode);
583 if (ret < 0)
584 return ret;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000585
586 odr_bits = kxcjk1013_convert_freq_to_bit(val, val2);
587 if (odr_bits < 0)
588 return odr_bits;
589
590 /* To change ODR, the chip must be set to STANDBY as per spec */
591 ret = kxcjk1013_set_mode(data, STANDBY);
592 if (ret < 0)
593 return ret;
594
595 ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_DATA_CTRL,
596 odr_bits);
597 if (ret < 0) {
598 dev_err(&data->client->dev, "Error writing data_ctrl\n");
599 return ret;
600 }
601
602 data->odr_bits = odr_bits;
603
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100604 odr_bits = kxcjk1013_convert_wake_odr_to_bit(val, val2);
605 if (odr_bits < 0)
606 return odr_bits;
607
608 ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_CTRL2,
609 odr_bits);
610 if (ret < 0) {
611 dev_err(&data->client->dev, "Error writing reg_ctrl2\n");
612 return ret;
613 }
614
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100615 if (store_mode == OPERATION) {
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000616 ret = kxcjk1013_set_mode(data, OPERATION);
617 if (ret < 0)
618 return ret;
619 }
620
621 return 0;
622}
623
624static int kxcjk1013_get_odr(struct kxcjk1013_data *data, int *val, int *val2)
625{
626 int i;
627
628 for (i = 0; i < ARRAY_SIZE(samp_freq_table); ++i) {
629 if (samp_freq_table[i].odr_bits == data->odr_bits) {
630 *val = samp_freq_table[i].val;
631 *val2 = samp_freq_table[i].val2;
632 return IIO_VAL_INT_PLUS_MICRO;
633 }
634 }
635
636 return -EINVAL;
637}
638
639static int kxcjk1013_get_acc_reg(struct kxcjk1013_data *data, int axis)
640{
641 u8 reg = KXCJK1013_REG_XOUT_L + axis * 2;
642 int ret;
643
644 ret = i2c_smbus_read_word_data(data->client, reg);
645 if (ret < 0) {
646 dev_err(&data->client->dev,
647 "failed to read accel_%c registers\n", 'x' + axis);
648 return ret;
649 }
650
651 return ret;
652}
653
Srinivas Pandruvadaa735e3d2014-05-08 22:58:00 +0100654static int kxcjk1013_set_scale(struct kxcjk1013_data *data, int val)
655{
656 int ret, i;
657 enum kxcjk1013_mode store_mode;
658
659
660 for (i = 0; i < ARRAY_SIZE(KXCJK1013_scale_table); ++i) {
661 if (KXCJK1013_scale_table[i].scale == val) {
662
663 ret = kxcjk1013_get_mode(data, &store_mode);
664 if (ret < 0)
665 return ret;
666
667 ret = kxcjk1013_set_mode(data, STANDBY);
668 if (ret < 0)
669 return ret;
670
671 ret = kxcjk1013_set_range(data, i);
672 if (ret < 0)
673 return ret;
674
675 if (store_mode == OPERATION) {
676 ret = kxcjk1013_set_mode(data, OPERATION);
677 if (ret)
678 return ret;
679 }
680
681 return 0;
682 }
683 }
684
685 return -EINVAL;
686}
687
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000688static int kxcjk1013_read_raw(struct iio_dev *indio_dev,
689 struct iio_chan_spec const *chan, int *val,
690 int *val2, long mask)
691{
692 struct kxcjk1013_data *data = iio_priv(indio_dev);
693 int ret;
694
695 switch (mask) {
696 case IIO_CHAN_INFO_RAW:
697 mutex_lock(&data->mutex);
698 if (iio_buffer_enabled(indio_dev))
699 ret = -EBUSY;
700 else {
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100701 ret = kxcjk1013_set_power_state(data, true);
Srinivas Pandruvada88f6da72014-06-16 20:00:00 +0100702 if (ret < 0) {
703 mutex_unlock(&data->mutex);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000704 return ret;
Srinivas Pandruvada88f6da72014-06-16 20:00:00 +0100705 }
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000706 ret = kxcjk1013_get_acc_reg(data, chan->scan_index);
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100707 if (ret < 0) {
708 kxcjk1013_set_power_state(data, false);
709 mutex_unlock(&data->mutex);
710 return ret;
711 }
712 *val = sign_extend32(ret >> 4, 11);
713 ret = kxcjk1013_set_power_state(data, false);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000714 }
715 mutex_unlock(&data->mutex);
716
717 if (ret < 0)
718 return ret;
719
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000720 return IIO_VAL_INT;
721
722 case IIO_CHAN_INFO_SCALE:
723 *val = 0;
Srinivas Pandruvadaa735e3d2014-05-08 22:58:00 +0100724 *val2 = KXCJK1013_scale_table[data->range].scale;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000725 return IIO_VAL_INT_PLUS_MICRO;
726
727 case IIO_CHAN_INFO_SAMP_FREQ:
728 mutex_lock(&data->mutex);
729 ret = kxcjk1013_get_odr(data, val, val2);
730 mutex_unlock(&data->mutex);
731 return ret;
732
733 default:
734 return -EINVAL;
735 }
736}
737
738static int kxcjk1013_write_raw(struct iio_dev *indio_dev,
739 struct iio_chan_spec const *chan, int val,
740 int val2, long mask)
741{
742 struct kxcjk1013_data *data = iio_priv(indio_dev);
743 int ret;
744
745 switch (mask) {
746 case IIO_CHAN_INFO_SAMP_FREQ:
747 mutex_lock(&data->mutex);
748 ret = kxcjk1013_set_odr(data, val, val2);
749 mutex_unlock(&data->mutex);
750 break;
Srinivas Pandruvadaa735e3d2014-05-08 22:58:00 +0100751 case IIO_CHAN_INFO_SCALE:
752 if (val)
753 return -EINVAL;
754
755 mutex_lock(&data->mutex);
756 ret = kxcjk1013_set_scale(data, val2);
757 mutex_unlock(&data->mutex);
758 break;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000759 default:
760 ret = -EINVAL;
761 }
762
763 return ret;
764}
765
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100766static int kxcjk1013_read_event(struct iio_dev *indio_dev,
767 const struct iio_chan_spec *chan,
768 enum iio_event_type type,
769 enum iio_event_direction dir,
770 enum iio_event_info info,
771 int *val, int *val2)
772{
773 struct kxcjk1013_data *data = iio_priv(indio_dev);
774
775 *val2 = 0;
776 switch (info) {
777 case IIO_EV_INFO_VALUE:
778 *val = data->wake_thres;
779 break;
780 case IIO_EV_INFO_PERIOD:
781 *val = data->wake_dur;
782 break;
783 default:
784 return -EINVAL;
785 }
786
787 return IIO_VAL_INT;
788}
789
790static int kxcjk1013_write_event(struct iio_dev *indio_dev,
791 const struct iio_chan_spec *chan,
792 enum iio_event_type type,
793 enum iio_event_direction dir,
794 enum iio_event_info info,
795 int val, int val2)
796{
797 struct kxcjk1013_data *data = iio_priv(indio_dev);
798
799 if (data->ev_enable_state)
800 return -EBUSY;
801
802 switch (info) {
803 case IIO_EV_INFO_VALUE:
804 data->wake_thres = val;
805 break;
806 case IIO_EV_INFO_PERIOD:
807 data->wake_dur = val;
808 break;
809 default:
810 return -EINVAL;
811 }
812
813 return 0;
814}
815
816static int kxcjk1013_read_event_config(struct iio_dev *indio_dev,
817 const struct iio_chan_spec *chan,
818 enum iio_event_type type,
819 enum iio_event_direction dir)
820{
821
822 struct kxcjk1013_data *data = iio_priv(indio_dev);
823
824 return data->ev_enable_state;
825}
826
827static int kxcjk1013_write_event_config(struct iio_dev *indio_dev,
828 const struct iio_chan_spec *chan,
829 enum iio_event_type type,
830 enum iio_event_direction dir,
831 int state)
832{
833 struct kxcjk1013_data *data = iio_priv(indio_dev);
834 int ret;
835
836 if (state && data->ev_enable_state)
837 return 0;
838
839 mutex_lock(&data->mutex);
840
841 if (!state && data->motion_trigger_on) {
842 data->ev_enable_state = 0;
843 mutex_unlock(&data->mutex);
844 return 0;
845 }
846
847 /*
848 * We will expect the enable and disable to do operation in
849 * in reverse order. This will happen here anyway as our
850 * resume operation uses sync mode runtime pm calls, the
851 * suspend operation will be delayed by autosuspend delay
852 * So the disable operation will still happen in reverse of
853 * enable operation. When runtime pm is disabled the mode
854 * is always on so sequence doesn't matter
855 */
856 ret = kxcjk1013_set_power_state(data, state);
857 if (ret < 0) {
858 mutex_unlock(&data->mutex);
859 return ret;
860 }
861
862 ret = kxcjk1013_setup_any_motion_interrupt(data, state);
863 if (ret < 0) {
Irina Tirdeafbd123e2014-12-10 18:23:53 +0200864 kxcjk1013_set_power_state(data, false);
865 data->ev_enable_state = 0;
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100866 mutex_unlock(&data->mutex);
867 return ret;
868 }
869
870 data->ev_enable_state = state;
871 mutex_unlock(&data->mutex);
872
873 return 0;
874}
875
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000876static int kxcjk1013_validate_trigger(struct iio_dev *indio_dev,
877 struct iio_trigger *trig)
878{
879 struct kxcjk1013_data *data = iio_priv(indio_dev);
880
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100881 if (data->dready_trig != trig && data->motion_trig != trig)
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000882 return -EINVAL;
883
884 return 0;
885}
886
887static IIO_CONST_ATTR_SAMP_FREQ_AVAIL(
888 "0.781000 1.563000 3.125000 6.250000 12.500000 25 50 100 200 400 800 1600");
889
Srinivas Pandruvadaa735e3d2014-05-08 22:58:00 +0100890static IIO_CONST_ATTR(in_accel_scale_available, "0.009582 0.019163 0.038326");
891
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000892static struct attribute *kxcjk1013_attributes[] = {
893 &iio_const_attr_sampling_frequency_available.dev_attr.attr,
Srinivas Pandruvadaa735e3d2014-05-08 22:58:00 +0100894 &iio_const_attr_in_accel_scale_available.dev_attr.attr,
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000895 NULL,
896};
897
898static const struct attribute_group kxcjk1013_attrs_group = {
899 .attrs = kxcjk1013_attributes,
900};
901
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100902static const struct iio_event_spec kxcjk1013_event = {
903 .type = IIO_EV_TYPE_THRESH,
904 .dir = IIO_EV_DIR_RISING | IIO_EV_DIR_FALLING,
905 .mask_separate = BIT(IIO_EV_INFO_VALUE) |
906 BIT(IIO_EV_INFO_ENABLE) |
907 BIT(IIO_EV_INFO_PERIOD)
908};
909
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000910#define KXCJK1013_CHANNEL(_axis) { \
911 .type = IIO_ACCEL, \
912 .modified = 1, \
913 .channel2 = IIO_MOD_##_axis, \
914 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
915 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
916 BIT(IIO_CHAN_INFO_SAMP_FREQ), \
917 .scan_index = AXIS_##_axis, \
918 .scan_type = { \
919 .sign = 's', \
920 .realbits = 12, \
921 .storagebits = 16, \
922 .shift = 4, \
Peter Meerwaldf4e2f94d2014-07-14 21:38:00 +0100923 .endianness = IIO_CPU, \
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000924 }, \
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100925 .event_spec = &kxcjk1013_event, \
926 .num_event_specs = 1 \
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000927}
928
929static const struct iio_chan_spec kxcjk1013_channels[] = {
930 KXCJK1013_CHANNEL(X),
931 KXCJK1013_CHANNEL(Y),
932 KXCJK1013_CHANNEL(Z),
933 IIO_CHAN_SOFT_TIMESTAMP(3),
934};
935
936static const struct iio_info kxcjk1013_info = {
937 .attrs = &kxcjk1013_attrs_group,
938 .read_raw = kxcjk1013_read_raw,
939 .write_raw = kxcjk1013_write_raw,
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100940 .read_event_value = kxcjk1013_read_event,
941 .write_event_value = kxcjk1013_write_event,
942 .write_event_config = kxcjk1013_write_event_config,
943 .read_event_config = kxcjk1013_read_event_config,
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000944 .validate_trigger = kxcjk1013_validate_trigger,
945 .driver_module = THIS_MODULE,
946};
947
948static irqreturn_t kxcjk1013_trigger_handler(int irq, void *p)
949{
950 struct iio_poll_func *pf = p;
951 struct iio_dev *indio_dev = pf->indio_dev;
952 struct kxcjk1013_data *data = iio_priv(indio_dev);
953 int bit, ret, i = 0;
954
955 mutex_lock(&data->mutex);
956
957 for_each_set_bit(bit, indio_dev->buffer->scan_mask,
958 indio_dev->masklength) {
959 ret = kxcjk1013_get_acc_reg(data, bit);
960 if (ret < 0) {
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000961 mutex_unlock(&data->mutex);
962 goto err;
963 }
964 data->buffer[i++] = ret;
965 }
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000966 mutex_unlock(&data->mutex);
967
968 iio_push_to_buffers_with_timestamp(indio_dev, data->buffer,
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100969 data->timestamp);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000970err:
971 iio_trigger_notify_done(indio_dev->trig);
972
973 return IRQ_HANDLED;
974}
975
Srinivas Pandruvada59bfeab2014-07-17 01:42:00 +0100976static int kxcjk1013_trig_try_reen(struct iio_trigger *trig)
977{
978 struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
979 struct kxcjk1013_data *data = iio_priv(indio_dev);
980 int ret;
981
982 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_REL);
983 if (ret < 0) {
984 dev_err(&data->client->dev, "Error reading reg_int_rel\n");
985 return ret;
986 }
987
988 return 0;
989}
990
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000991static int kxcjk1013_data_rdy_trigger_set_state(struct iio_trigger *trig,
992 bool state)
993{
994 struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
995 struct kxcjk1013_data *data = iio_priv(indio_dev);
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +0100996 int ret;
997
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +0000998 mutex_lock(&data->mutex);
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +0100999
1000 if (!state && data->ev_enable_state && data->motion_trigger_on) {
1001 data->motion_trigger_on = false;
1002 mutex_unlock(&data->mutex);
1003 return 0;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001004 }
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001005
1006 ret = kxcjk1013_set_power_state(data, state);
1007 if (ret < 0) {
1008 mutex_unlock(&data->mutex);
1009 return ret;
1010 }
1011 if (data->motion_trig == trig)
1012 ret = kxcjk1013_setup_any_motion_interrupt(data, state);
1013 else
1014 ret = kxcjk1013_setup_new_data_interrupt(data, state);
1015 if (ret < 0) {
Irina Tirdeafbd123e2014-12-10 18:23:53 +02001016 kxcjk1013_set_power_state(data, false);
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001017 mutex_unlock(&data->mutex);
1018 return ret;
1019 }
1020 if (data->motion_trig == trig)
1021 data->motion_trigger_on = state;
1022 else
1023 data->dready_trigger_on = state;
1024
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001025 mutex_unlock(&data->mutex);
1026
1027 return 0;
1028}
1029
1030static const struct iio_trigger_ops kxcjk1013_trigger_ops = {
1031 .set_trigger_state = kxcjk1013_data_rdy_trigger_set_state,
Srinivas Pandruvada59bfeab2014-07-17 01:42:00 +01001032 .try_reenable = kxcjk1013_trig_try_reen,
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001033 .owner = THIS_MODULE,
1034};
1035
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001036static irqreturn_t kxcjk1013_event_handler(int irq, void *private)
1037{
1038 struct iio_dev *indio_dev = private;
1039 struct kxcjk1013_data *data = iio_priv(indio_dev);
1040 int ret;
1041
1042 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_SRC1);
1043 if (ret < 0) {
1044 dev_err(&data->client->dev, "Error reading reg_int_src1\n");
1045 goto ack_intr;
1046 }
1047
1048 if (ret & 0x02) {
1049 ret = i2c_smbus_read_byte_data(data->client,
1050 KXCJK1013_REG_INT_SRC2);
1051 if (ret < 0) {
1052 dev_err(&data->client->dev,
1053 "Error reading reg_int_src2\n");
1054 goto ack_intr;
1055 }
1056
1057 if (ret & KXCJK1013_REG_INT_SRC2_BIT_XN)
1058 iio_push_event(indio_dev,
1059 IIO_MOD_EVENT_CODE(IIO_ACCEL,
1060 0,
1061 IIO_MOD_X,
1062 IIO_EV_TYPE_THRESH,
1063 IIO_EV_DIR_FALLING),
1064 data->timestamp);
1065 if (ret & KXCJK1013_REG_INT_SRC2_BIT_XP)
1066 iio_push_event(indio_dev,
1067 IIO_MOD_EVENT_CODE(IIO_ACCEL,
1068 0,
1069 IIO_MOD_X,
1070 IIO_EV_TYPE_THRESH,
1071 IIO_EV_DIR_RISING),
1072 data->timestamp);
1073
1074
1075 if (ret & KXCJK1013_REG_INT_SRC2_BIT_YN)
1076 iio_push_event(indio_dev,
1077 IIO_MOD_EVENT_CODE(IIO_ACCEL,
1078 0,
1079 IIO_MOD_Y,
1080 IIO_EV_TYPE_THRESH,
1081 IIO_EV_DIR_FALLING),
1082 data->timestamp);
1083 if (ret & KXCJK1013_REG_INT_SRC2_BIT_YP)
1084 iio_push_event(indio_dev,
1085 IIO_MOD_EVENT_CODE(IIO_ACCEL,
1086 0,
1087 IIO_MOD_Y,
1088 IIO_EV_TYPE_THRESH,
1089 IIO_EV_DIR_RISING),
1090 data->timestamp);
1091
1092 if (ret & KXCJK1013_REG_INT_SRC2_BIT_ZN)
1093 iio_push_event(indio_dev,
1094 IIO_MOD_EVENT_CODE(IIO_ACCEL,
1095 0,
1096 IIO_MOD_Z,
1097 IIO_EV_TYPE_THRESH,
1098 IIO_EV_DIR_FALLING),
1099 data->timestamp);
1100 if (ret & KXCJK1013_REG_INT_SRC2_BIT_ZP)
1101 iio_push_event(indio_dev,
1102 IIO_MOD_EVENT_CODE(IIO_ACCEL,
1103 0,
1104 IIO_MOD_Z,
1105 IIO_EV_TYPE_THRESH,
1106 IIO_EV_DIR_RISING),
1107 data->timestamp);
1108 }
1109
1110ack_intr:
1111 if (data->dready_trigger_on)
1112 return IRQ_HANDLED;
1113
1114 ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_REL);
1115 if (ret < 0)
1116 dev_err(&data->client->dev, "Error reading reg_int_rel\n");
1117
1118 return IRQ_HANDLED;
1119}
1120
1121static irqreturn_t kxcjk1013_data_rdy_trig_poll(int irq, void *private)
1122{
1123 struct iio_dev *indio_dev = private;
1124 struct kxcjk1013_data *data = iio_priv(indio_dev);
1125
1126 data->timestamp = iio_get_time_ns();
1127
1128 if (data->dready_trigger_on)
1129 iio_trigger_poll(data->dready_trig);
1130 else if (data->motion_trigger_on)
1131 iio_trigger_poll(data->motion_trig);
1132
1133 if (data->ev_enable_state)
1134 return IRQ_WAKE_THREAD;
1135 else
1136 return IRQ_HANDLED;
1137}
1138
Daniel Balutac6861372014-03-09 08:33:00 +00001139static const char *kxcjk1013_match_acpi_device(struct device *dev,
Bastien Nocera3bfa74f2014-05-11 22:09:00 +01001140 enum kx_chipset *chipset,
1141 bool *is_smo8500_device)
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001142{
1143 const struct acpi_device_id *id;
Roberta Dobrescub0868df2014-12-30 20:57:53 +02001144
Daniel Balutac6861372014-03-09 08:33:00 +00001145 id = acpi_match_device(dev->driver->acpi_match_table, dev);
1146 if (!id)
1147 return NULL;
Bastien Nocera3bfa74f2014-05-11 22:09:00 +01001148 if (strcmp(id->id, "SMO8500") == 0)
1149 *is_smo8500_device = true;
Daniel Balutac6861372014-03-09 08:33:00 +00001150 *chipset = (enum kx_chipset)id->driver_data;
1151
1152 return dev_name(dev);
1153}
1154
1155static int kxcjk1013_gpio_probe(struct i2c_client *client,
1156 struct kxcjk1013_data *data)
1157{
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001158 struct device *dev;
1159 struct gpio_desc *gpio;
1160 int ret;
1161
1162 if (!client)
1163 return -EINVAL;
Bastien Nocera3bfa74f2014-05-11 22:09:00 +01001164 if (data->is_smo8500_device)
1165 return -ENOTSUPP;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001166
1167 dev = &client->dev;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001168
1169 /* data ready gpio interrupt pin */
1170 gpio = devm_gpiod_get_index(dev, "kxcjk1013_int", 0);
1171 if (IS_ERR(gpio)) {
1172 dev_err(dev, "acpi gpio get index failed\n");
1173 return PTR_ERR(gpio);
1174 }
1175
1176 ret = gpiod_direction_input(gpio);
1177 if (ret)
1178 return ret;
1179
1180 ret = gpiod_to_irq(gpio);
1181
1182 dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret);
1183
1184 return ret;
1185}
1186
1187static int kxcjk1013_probe(struct i2c_client *client,
1188 const struct i2c_device_id *id)
1189{
1190 struct kxcjk1013_data *data;
1191 struct iio_dev *indio_dev;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001192 struct kxcjk_1013_platform_data *pdata;
Daniel Balutac6861372014-03-09 08:33:00 +00001193 const char *name;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001194 int ret;
1195
1196 indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
1197 if (!indio_dev)
1198 return -ENOMEM;
1199
1200 data = iio_priv(indio_dev);
1201 i2c_set_clientdata(client, indio_dev);
1202 data->client = client;
1203
1204 pdata = dev_get_platdata(&client->dev);
1205 if (pdata)
1206 data->active_high_intr = pdata->active_high_intr;
1207 else
1208 data->active_high_intr = true; /* default polarity */
1209
Daniel Balutac6861372014-03-09 08:33:00 +00001210 if (id) {
1211 data->chipset = (enum kx_chipset)(id->driver_data);
1212 name = id->name;
1213 } else if (ACPI_HANDLE(&client->dev)) {
1214 name = kxcjk1013_match_acpi_device(&client->dev,
Bastien Nocera3bfa74f2014-05-11 22:09:00 +01001215 &data->chipset,
1216 &data->is_smo8500_device);
Daniel Balutac6861372014-03-09 08:33:00 +00001217 } else
1218 return -ENODEV;
1219
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001220 ret = kxcjk1013_chip_init(data);
1221 if (ret < 0)
1222 return ret;
1223
1224 mutex_init(&data->mutex);
1225
1226 indio_dev->dev.parent = &client->dev;
1227 indio_dev->channels = kxcjk1013_channels;
1228 indio_dev->num_channels = ARRAY_SIZE(kxcjk1013_channels);
Daniel Balutac6861372014-03-09 08:33:00 +00001229 indio_dev->name = name;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001230 indio_dev->modes = INDIO_DIRECT_MODE;
1231 indio_dev->info = &kxcjk1013_info;
1232
1233 if (client->irq < 0)
Daniel Balutac6861372014-03-09 08:33:00 +00001234 client->irq = kxcjk1013_gpio_probe(client, data);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001235
1236 if (client->irq >= 0) {
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001237 ret = devm_request_threaded_irq(&client->dev, client->irq,
1238 kxcjk1013_data_rdy_trig_poll,
1239 kxcjk1013_event_handler,
1240 IRQF_TRIGGER_RISING,
1241 KXCJK1013_IRQ_NAME,
1242 indio_dev);
1243 if (ret)
Irina Tirdea9d02daf732014-12-10 18:23:54 +02001244 goto err_poweroff;
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001245
1246 data->dready_trig = devm_iio_trigger_alloc(&client->dev,
1247 "%s-dev%d",
1248 indio_dev->name,
1249 indio_dev->id);
Irina Tirdea9d02daf732014-12-10 18:23:54 +02001250 if (!data->dready_trig) {
1251 ret = -ENOMEM;
1252 goto err_poweroff;
1253 }
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001254
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001255 data->motion_trig = devm_iio_trigger_alloc(&client->dev,
1256 "%s-any-motion-dev%d",
1257 indio_dev->name,
1258 indio_dev->id);
Irina Tirdea9d02daf732014-12-10 18:23:54 +02001259 if (!data->motion_trig) {
1260 ret = -ENOMEM;
1261 goto err_poweroff;
1262 }
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001263
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001264 data->dready_trig->dev.parent = &client->dev;
1265 data->dready_trig->ops = &kxcjk1013_trigger_ops;
1266 iio_trigger_set_drvdata(data->dready_trig, indio_dev);
1267 indio_dev->trig = data->dready_trig;
Srinivas Pandruvadac1288b82014-07-17 01:42:00 +01001268 iio_trigger_get(indio_dev->trig);
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001269 ret = iio_trigger_register(data->dready_trig);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001270 if (ret)
Irina Tirdea9d02daf732014-12-10 18:23:54 +02001271 goto err_poweroff;
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001272
1273 data->motion_trig->dev.parent = &client->dev;
1274 data->motion_trig->ops = &kxcjk1013_trigger_ops;
1275 iio_trigger_set_drvdata(data->motion_trig, indio_dev);
1276 ret = iio_trigger_register(data->motion_trig);
1277 if (ret) {
1278 data->motion_trig = NULL;
1279 goto err_trigger_unregister;
1280 }
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001281
1282 ret = iio_triggered_buffer_setup(indio_dev,
1283 &iio_pollfunc_store_time,
1284 kxcjk1013_trigger_handler,
1285 NULL);
1286 if (ret < 0) {
1287 dev_err(&client->dev,
1288 "iio triggered buffer setup failed\n");
1289 goto err_trigger_unregister;
1290 }
1291 }
1292
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001293 ret = iio_device_register(indio_dev);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001294 if (ret < 0) {
1295 dev_err(&client->dev, "unable to register iio device\n");
1296 goto err_buffer_cleanup;
1297 }
1298
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001299 ret = pm_runtime_set_active(&client->dev);
1300 if (ret)
1301 goto err_iio_unregister;
1302
1303 pm_runtime_enable(&client->dev);
1304 pm_runtime_set_autosuspend_delay(&client->dev,
1305 KXCJK1013_SLEEP_DELAY_MS);
1306 pm_runtime_use_autosuspend(&client->dev);
1307
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001308 return 0;
1309
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001310err_iio_unregister:
1311 iio_device_unregister(indio_dev);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001312err_buffer_cleanup:
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001313 if (data->dready_trig)
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001314 iio_triggered_buffer_cleanup(indio_dev);
1315err_trigger_unregister:
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001316 if (data->dready_trig)
1317 iio_trigger_unregister(data->dready_trig);
1318 if (data->motion_trig)
1319 iio_trigger_unregister(data->motion_trig);
Irina Tirdea9d02daf732014-12-10 18:23:54 +02001320err_poweroff:
1321 kxcjk1013_set_mode(data, STANDBY);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001322
1323 return ret;
1324}
1325
1326static int kxcjk1013_remove(struct i2c_client *client)
1327{
1328 struct iio_dev *indio_dev = i2c_get_clientdata(client);
1329 struct kxcjk1013_data *data = iio_priv(indio_dev);
1330
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001331 pm_runtime_disable(&client->dev);
1332 pm_runtime_set_suspended(&client->dev);
1333 pm_runtime_put_noidle(&client->dev);
1334
1335 iio_device_unregister(indio_dev);
1336
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001337 if (data->dready_trig) {
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001338 iio_triggered_buffer_cleanup(indio_dev);
Srinivas Pandruvadab4b491c2014-08-22 20:01:00 +01001339 iio_trigger_unregister(data->dready_trig);
1340 iio_trigger_unregister(data->motion_trig);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001341 }
1342
1343 mutex_lock(&data->mutex);
1344 kxcjk1013_set_mode(data, STANDBY);
1345 mutex_unlock(&data->mutex);
1346
1347 return 0;
1348}
1349
1350#ifdef CONFIG_PM_SLEEP
1351static int kxcjk1013_suspend(struct device *dev)
1352{
1353 struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1354 struct kxcjk1013_data *data = iio_priv(indio_dev);
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001355 int ret;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001356
1357 mutex_lock(&data->mutex);
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001358 ret = kxcjk1013_set_mode(data, STANDBY);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001359 mutex_unlock(&data->mutex);
1360
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001361 return ret;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001362}
1363
1364static int kxcjk1013_resume(struct device *dev)
1365{
1366 struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1367 struct kxcjk1013_data *data = iio_priv(indio_dev);
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001368 int ret = 0;
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001369
1370 mutex_lock(&data->mutex);
Irina Tirdead3653d02014-12-06 00:18:07 +02001371 ret = kxcjk1013_set_mode(data, OPERATION);
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001372 mutex_unlock(&data->mutex);
1373
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001374 return ret;
1375}
1376#endif
1377
1378#ifdef CONFIG_PM_RUNTIME
1379static int kxcjk1013_runtime_suspend(struct device *dev)
1380{
1381 struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1382 struct kxcjk1013_data *data = iio_priv(indio_dev);
Irina Tirdeafbd123e2014-12-10 18:23:53 +02001383 int ret;
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001384
Irina Tirdeafbd123e2014-12-10 18:23:53 +02001385 ret = kxcjk1013_set_mode(data, STANDBY);
1386 if (ret < 0) {
1387 dev_err(&data->client->dev, "powering off device failed\n");
1388 return -EAGAIN;
1389 }
1390 return 0;
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001391}
1392
1393static int kxcjk1013_runtime_resume(struct device *dev)
1394{
1395 struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
1396 struct kxcjk1013_data *data = iio_priv(indio_dev);
1397 int ret;
1398 int sleep_val;
1399
1400 ret = kxcjk1013_set_mode(data, OPERATION);
1401 if (ret < 0)
1402 return ret;
1403
1404 sleep_val = kxcjk1013_get_startup_times(data);
1405 if (sleep_val < 20000)
1406 usleep_range(sleep_val, 20000);
1407 else
1408 msleep_interruptible(sleep_val/1000);
1409
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001410 return 0;
1411}
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001412#endif
1413
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001414static const struct dev_pm_ops kxcjk1013_pm_ops = {
1415 SET_SYSTEM_SLEEP_PM_OPS(kxcjk1013_suspend, kxcjk1013_resume)
1416 SET_RUNTIME_PM_OPS(kxcjk1013_runtime_suspend,
1417 kxcjk1013_runtime_resume, NULL)
1418};
1419
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001420static const struct acpi_device_id kx_acpi_match[] = {
Daniel Balutac6861372014-03-09 08:33:00 +00001421 {"KXCJ1013", KXCJK1013},
1422 {"KXCJ1008", KXCJ91008},
1423 {"KXTJ1009", KXTJ21009},
Bastien Nocera3bfa74f2014-05-11 22:09:00 +01001424 {"SMO8500", KXCJ91008},
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001425 { },
1426};
1427MODULE_DEVICE_TABLE(acpi, kx_acpi_match);
1428
1429static const struct i2c_device_id kxcjk1013_id[] = {
Daniel Balutac6861372014-03-09 08:33:00 +00001430 {"kxcjk1013", KXCJK1013},
1431 {"kxcj91008", KXCJ91008},
1432 {"kxtj21009", KXTJ21009},
Bastien Nocera3bfa74f2014-05-11 22:09:00 +01001433 {"SMO8500", KXCJ91008},
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001434 {}
1435};
1436
1437MODULE_DEVICE_TABLE(i2c, kxcjk1013_id);
1438
1439static struct i2c_driver kxcjk1013_driver = {
1440 .driver = {
1441 .name = KXCJK1013_DRV_NAME,
1442 .acpi_match_table = ACPI_PTR(kx_acpi_match),
Srinivas Pandruvada124e1b1d2014-05-08 22:58:00 +01001443 .pm = &kxcjk1013_pm_ops,
Srinivas Pandruvada1a4fbf62014-11-06 23:07:00 +00001444 },
1445 .probe = kxcjk1013_probe,
1446 .remove = kxcjk1013_remove,
1447 .id_table = kxcjk1013_id,
1448};
1449module_i2c_driver(kxcjk1013_driver);
1450
1451MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>");
1452MODULE_LICENSE("GPL v2");
1453MODULE_DESCRIPTION("KXCJK1013 accelerometer driver");