145051539SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2e8e70d83SChris Hudson /*
3e8e70d83SChris Hudson * Copyright (C) 2011 Kionix, Inc.
4e8e70d83SChris Hudson * Written by Chris Hudson <chudson@kionix.com>
5e8e70d83SChris Hudson */
6e8e70d83SChris Hudson
7e8e70d83SChris Hudson #include <linux/delay.h>
8e8e70d83SChris Hudson #include <linux/i2c.h>
9e8e70d83SChris Hudson #include <linux/input.h>
10e8e70d83SChris Hudson #include <linux/interrupt.h>
112501ec97SStephen Rothwell #include <linux/module.h>
12e8e70d83SChris Hudson #include <linux/slab.h>
13e8e70d83SChris Hudson #include <linux/input/kxtj9.h>
14e8e70d83SChris Hudson
15e8e70d83SChris Hudson #define NAME "kxtj9"
16e8e70d83SChris Hudson #define G_MAX 8000
17e8e70d83SChris Hudson /* OUTPUT REGISTERS */
18e8e70d83SChris Hudson #define XOUT_L 0x06
19e8e70d83SChris Hudson #define WHO_AM_I 0x0F
20e8e70d83SChris Hudson /* CONTROL REGISTERS */
21e8e70d83SChris Hudson #define INT_REL 0x1A
22e8e70d83SChris Hudson #define CTRL_REG1 0x1B
23e8e70d83SChris Hudson #define INT_CTRL1 0x1E
24e8e70d83SChris Hudson #define DATA_CTRL 0x21
25e8e70d83SChris Hudson /* CONTROL REGISTER 1 BITS */
26e8e70d83SChris Hudson #define PC1_OFF 0x7F
27e8e70d83SChris Hudson #define PC1_ON (1 << 7)
28e8e70d83SChris Hudson /* Data ready funtion enable bit: set during probe if using irq mode */
29e8e70d83SChris Hudson #define DRDYE (1 << 5)
3004391660SChristopher Hudson /* DATA CONTROL REGISTER BITS */
3104391660SChristopher Hudson #define ODR12_5F 0
3204391660SChristopher Hudson #define ODR25F 1
3304391660SChristopher Hudson #define ODR50F 2
3404391660SChristopher Hudson #define ODR100F 3
3504391660SChristopher Hudson #define ODR200F 4
3604391660SChristopher Hudson #define ODR400F 5
3704391660SChristopher Hudson #define ODR800F 6
38e8e70d83SChris Hudson /* INTERRUPT CONTROL REGISTER 1 BITS */
39e8e70d83SChris Hudson /* Set these during probe if using irq mode */
40e8e70d83SChris Hudson #define KXTJ9_IEL (1 << 3)
41e8e70d83SChris Hudson #define KXTJ9_IEA (1 << 4)
42e8e70d83SChris Hudson #define KXTJ9_IEN (1 << 5)
43e8e70d83SChris Hudson /* INPUT_ABS CONSTANTS */
44e8e70d83SChris Hudson #define FUZZ 3
45e8e70d83SChris Hudson #define FLAT 3
46e8e70d83SChris Hudson /* RESUME STATE INDICES */
47e8e70d83SChris Hudson #define RES_DATA_CTRL 0
48e8e70d83SChris Hudson #define RES_CTRL_REG1 1
49e8e70d83SChris Hudson #define RES_INT_CTRL1 2
50e8e70d83SChris Hudson #define RESUME_ENTRIES 3
51e8e70d83SChris Hudson
52e8e70d83SChris Hudson /*
53e8e70d83SChris Hudson * The following table lists the maximum appropriate poll interval for each
54e8e70d83SChris Hudson * available output data rate.
55e8e70d83SChris Hudson */
56e8e70d83SChris Hudson static const struct {
57e8e70d83SChris Hudson unsigned int cutoff;
58e8e70d83SChris Hudson u8 mask;
59e8e70d83SChris Hudson } kxtj9_odr_table[] = {
60e8e70d83SChris Hudson { 3, ODR800F },
61e8e70d83SChris Hudson { 5, ODR400F },
62e8e70d83SChris Hudson { 10, ODR200F },
63e8e70d83SChris Hudson { 20, ODR100F },
64e8e70d83SChris Hudson { 40, ODR50F },
65e8e70d83SChris Hudson { 80, ODR25F },
66e8e70d83SChris Hudson { 0, ODR12_5F},
67e8e70d83SChris Hudson };
68e8e70d83SChris Hudson
69e8e70d83SChris Hudson struct kxtj9_data {
70e8e70d83SChris Hudson struct i2c_client *client;
71e8e70d83SChris Hudson struct kxtj9_platform_data pdata;
72e8e70d83SChris Hudson struct input_dev *input_dev;
73e8e70d83SChris Hudson unsigned int last_poll_interval;
74e8e70d83SChris Hudson u8 shift;
75e8e70d83SChris Hudson u8 ctrl_reg1;
76e8e70d83SChris Hudson u8 data_ctrl;
77e8e70d83SChris Hudson u8 int_ctrl;
78e8e70d83SChris Hudson };
79e8e70d83SChris Hudson
kxtj9_i2c_read(struct kxtj9_data * tj9,u8 addr,u8 * data,int len)80e8e70d83SChris Hudson static int kxtj9_i2c_read(struct kxtj9_data *tj9, u8 addr, u8 *data, int len)
81e8e70d83SChris Hudson {
82e8e70d83SChris Hudson struct i2c_msg msgs[] = {
83e8e70d83SChris Hudson {
84e8e70d83SChris Hudson .addr = tj9->client->addr,
85e8e70d83SChris Hudson .flags = tj9->client->flags,
86e8e70d83SChris Hudson .len = 1,
87e8e70d83SChris Hudson .buf = &addr,
88e8e70d83SChris Hudson },
89e8e70d83SChris Hudson {
90e8e70d83SChris Hudson .addr = tj9->client->addr,
91e8e70d83SChris Hudson .flags = tj9->client->flags | I2C_M_RD,
92e8e70d83SChris Hudson .len = len,
93e8e70d83SChris Hudson .buf = data,
94e8e70d83SChris Hudson },
95e8e70d83SChris Hudson };
96e8e70d83SChris Hudson
97e8e70d83SChris Hudson return i2c_transfer(tj9->client->adapter, msgs, 2);
98e8e70d83SChris Hudson }
99e8e70d83SChris Hudson
kxtj9_report_acceleration_data(struct kxtj9_data * tj9)100e8e70d83SChris Hudson static void kxtj9_report_acceleration_data(struct kxtj9_data *tj9)
101e8e70d83SChris Hudson {
102e8e70d83SChris Hudson s16 acc_data[3]; /* Data bytes from hardware xL, xH, yL, yH, zL, zH */
103e8e70d83SChris Hudson s16 x, y, z;
104e8e70d83SChris Hudson int err;
105e8e70d83SChris Hudson
106e8e70d83SChris Hudson err = kxtj9_i2c_read(tj9, XOUT_L, (u8 *)acc_data, 6);
107e8e70d83SChris Hudson if (err < 0)
108e8e70d83SChris Hudson dev_err(&tj9->client->dev, "accelerometer data read failed\n");
109e8e70d83SChris Hudson
11004391660SChristopher Hudson x = le16_to_cpu(acc_data[tj9->pdata.axis_map_x]);
11104391660SChristopher Hudson y = le16_to_cpu(acc_data[tj9->pdata.axis_map_y]);
11204391660SChristopher Hudson z = le16_to_cpu(acc_data[tj9->pdata.axis_map_z]);
11304391660SChristopher Hudson
11404391660SChristopher Hudson x >>= tj9->shift;
11504391660SChristopher Hudson y >>= tj9->shift;
11604391660SChristopher Hudson z >>= tj9->shift;
117e8e70d83SChris Hudson
118e8e70d83SChris Hudson input_report_abs(tj9->input_dev, ABS_X, tj9->pdata.negate_x ? -x : x);
119e8e70d83SChris Hudson input_report_abs(tj9->input_dev, ABS_Y, tj9->pdata.negate_y ? -y : y);
120e8e70d83SChris Hudson input_report_abs(tj9->input_dev, ABS_Z, tj9->pdata.negate_z ? -z : z);
121e8e70d83SChris Hudson input_sync(tj9->input_dev);
122e8e70d83SChris Hudson }
123e8e70d83SChris Hudson
kxtj9_isr(int irq,void * dev)124e8e70d83SChris Hudson static irqreturn_t kxtj9_isr(int irq, void *dev)
125e8e70d83SChris Hudson {
126e8e70d83SChris Hudson struct kxtj9_data *tj9 = dev;
127e8e70d83SChris Hudson int err;
128e8e70d83SChris Hudson
129e8e70d83SChris Hudson /* data ready is the only possible interrupt type */
130e8e70d83SChris Hudson kxtj9_report_acceleration_data(tj9);
131e8e70d83SChris Hudson
132e8e70d83SChris Hudson err = i2c_smbus_read_byte_data(tj9->client, INT_REL);
133e8e70d83SChris Hudson if (err < 0)
134e8e70d83SChris Hudson dev_err(&tj9->client->dev,
135e8e70d83SChris Hudson "error clearing interrupt status: %d\n", err);
136e8e70d83SChris Hudson
137e8e70d83SChris Hudson return IRQ_HANDLED;
138e8e70d83SChris Hudson }
139e8e70d83SChris Hudson
kxtj9_update_g_range(struct kxtj9_data * tj9,u8 new_g_range)140e8e70d83SChris Hudson static int kxtj9_update_g_range(struct kxtj9_data *tj9, u8 new_g_range)
141e8e70d83SChris Hudson {
142e8e70d83SChris Hudson switch (new_g_range) {
143e8e70d83SChris Hudson case KXTJ9_G_2G:
144e8e70d83SChris Hudson tj9->shift = 4;
145e8e70d83SChris Hudson break;
146e8e70d83SChris Hudson case KXTJ9_G_4G:
147e8e70d83SChris Hudson tj9->shift = 3;
148e8e70d83SChris Hudson break;
149e8e70d83SChris Hudson case KXTJ9_G_8G:
150e8e70d83SChris Hudson tj9->shift = 2;
151e8e70d83SChris Hudson break;
152e8e70d83SChris Hudson default:
153e8e70d83SChris Hudson return -EINVAL;
154e8e70d83SChris Hudson }
155e8e70d83SChris Hudson
156e8e70d83SChris Hudson tj9->ctrl_reg1 &= 0xe7;
157e8e70d83SChris Hudson tj9->ctrl_reg1 |= new_g_range;
158e8e70d83SChris Hudson
159e8e70d83SChris Hudson return 0;
160e8e70d83SChris Hudson }
161e8e70d83SChris Hudson
kxtj9_update_odr(struct kxtj9_data * tj9,unsigned int poll_interval)162e8e70d83SChris Hudson static int kxtj9_update_odr(struct kxtj9_data *tj9, unsigned int poll_interval)
163e8e70d83SChris Hudson {
164e8e70d83SChris Hudson int err;
165e8e70d83SChris Hudson int i;
166e8e70d83SChris Hudson
167e8e70d83SChris Hudson /* Use the lowest ODR that can support the requested poll interval */
168e8e70d83SChris Hudson for (i = 0; i < ARRAY_SIZE(kxtj9_odr_table); i++) {
169e8e70d83SChris Hudson tj9->data_ctrl = kxtj9_odr_table[i].mask;
170e8e70d83SChris Hudson if (poll_interval < kxtj9_odr_table[i].cutoff)
171e8e70d83SChris Hudson break;
172e8e70d83SChris Hudson }
173e8e70d83SChris Hudson
174e8e70d83SChris Hudson err = i2c_smbus_write_byte_data(tj9->client, CTRL_REG1, 0);
175e8e70d83SChris Hudson if (err < 0)
176e8e70d83SChris Hudson return err;
177e8e70d83SChris Hudson
178e8e70d83SChris Hudson err = i2c_smbus_write_byte_data(tj9->client, DATA_CTRL, tj9->data_ctrl);
179e8e70d83SChris Hudson if (err < 0)
180e8e70d83SChris Hudson return err;
181e8e70d83SChris Hudson
182e8e70d83SChris Hudson err = i2c_smbus_write_byte_data(tj9->client, CTRL_REG1, tj9->ctrl_reg1);
183e8e70d83SChris Hudson if (err < 0)
184e8e70d83SChris Hudson return err;
185e8e70d83SChris Hudson
186e8e70d83SChris Hudson return 0;
187e8e70d83SChris Hudson }
188e8e70d83SChris Hudson
kxtj9_device_power_on(struct kxtj9_data * tj9)189e8e70d83SChris Hudson static int kxtj9_device_power_on(struct kxtj9_data *tj9)
190e8e70d83SChris Hudson {
191e8e70d83SChris Hudson if (tj9->pdata.power_on)
192e8e70d83SChris Hudson return tj9->pdata.power_on();
193e8e70d83SChris Hudson
194e8e70d83SChris Hudson return 0;
195e8e70d83SChris Hudson }
196e8e70d83SChris Hudson
kxtj9_device_power_off(struct kxtj9_data * tj9)197e8e70d83SChris Hudson static void kxtj9_device_power_off(struct kxtj9_data *tj9)
198e8e70d83SChris Hudson {
199e8e70d83SChris Hudson int err;
200e8e70d83SChris Hudson
201e8e70d83SChris Hudson tj9->ctrl_reg1 &= PC1_OFF;
202e8e70d83SChris Hudson err = i2c_smbus_write_byte_data(tj9->client, CTRL_REG1, tj9->ctrl_reg1);
203e8e70d83SChris Hudson if (err < 0)
204e8e70d83SChris Hudson dev_err(&tj9->client->dev, "soft power off failed\n");
205e8e70d83SChris Hudson
206e8e70d83SChris Hudson if (tj9->pdata.power_off)
207e8e70d83SChris Hudson tj9->pdata.power_off();
208e8e70d83SChris Hudson }
209e8e70d83SChris Hudson
kxtj9_enable(struct kxtj9_data * tj9)210e8e70d83SChris Hudson static int kxtj9_enable(struct kxtj9_data *tj9)
211e8e70d83SChris Hudson {
212e8e70d83SChris Hudson int err;
213e8e70d83SChris Hudson
214e8e70d83SChris Hudson err = kxtj9_device_power_on(tj9);
215e8e70d83SChris Hudson if (err < 0)
216e8e70d83SChris Hudson return err;
217e8e70d83SChris Hudson
218e8e70d83SChris Hudson /* ensure that PC1 is cleared before updating control registers */
219e8e70d83SChris Hudson err = i2c_smbus_write_byte_data(tj9->client, CTRL_REG1, 0);
220e8e70d83SChris Hudson if (err < 0)
221e8e70d83SChris Hudson return err;
222e8e70d83SChris Hudson
223e8e70d83SChris Hudson /* only write INT_CTRL_REG1 if in irq mode */
224e8e70d83SChris Hudson if (tj9->client->irq) {
225e8e70d83SChris Hudson err = i2c_smbus_write_byte_data(tj9->client,
226e8e70d83SChris Hudson INT_CTRL1, tj9->int_ctrl);
227e8e70d83SChris Hudson if (err < 0)
228e8e70d83SChris Hudson return err;
229e8e70d83SChris Hudson }
230e8e70d83SChris Hudson
231e8e70d83SChris Hudson err = kxtj9_update_g_range(tj9, tj9->pdata.g_range);
232e8e70d83SChris Hudson if (err < 0)
233e8e70d83SChris Hudson return err;
234e8e70d83SChris Hudson
235e8e70d83SChris Hudson /* turn on outputs */
236e8e70d83SChris Hudson tj9->ctrl_reg1 |= PC1_ON;
237e8e70d83SChris Hudson err = i2c_smbus_write_byte_data(tj9->client, CTRL_REG1, tj9->ctrl_reg1);
238e8e70d83SChris Hudson if (err < 0)
239e8e70d83SChris Hudson return err;
240e8e70d83SChris Hudson
241e8e70d83SChris Hudson err = kxtj9_update_odr(tj9, tj9->last_poll_interval);
242e8e70d83SChris Hudson if (err < 0)
243e8e70d83SChris Hudson return err;
244e8e70d83SChris Hudson
245e8e70d83SChris Hudson /* clear initial interrupt if in irq mode */
246e8e70d83SChris Hudson if (tj9->client->irq) {
247e8e70d83SChris Hudson err = i2c_smbus_read_byte_data(tj9->client, INT_REL);
248e8e70d83SChris Hudson if (err < 0) {
249e8e70d83SChris Hudson dev_err(&tj9->client->dev,
250e8e70d83SChris Hudson "error clearing interrupt: %d\n", err);
251e8e70d83SChris Hudson goto fail;
252e8e70d83SChris Hudson }
253e8e70d83SChris Hudson }
254e8e70d83SChris Hudson
255e8e70d83SChris Hudson return 0;
256e8e70d83SChris Hudson
257e8e70d83SChris Hudson fail:
258e8e70d83SChris Hudson kxtj9_device_power_off(tj9);
259e8e70d83SChris Hudson return err;
260e8e70d83SChris Hudson }
261e8e70d83SChris Hudson
kxtj9_disable(struct kxtj9_data * tj9)262e8e70d83SChris Hudson static void kxtj9_disable(struct kxtj9_data *tj9)
263e8e70d83SChris Hudson {
264e8e70d83SChris Hudson kxtj9_device_power_off(tj9);
265e8e70d83SChris Hudson }
266e8e70d83SChris Hudson
kxtj9_input_open(struct input_dev * input)267e8e70d83SChris Hudson static int kxtj9_input_open(struct input_dev *input)
268e8e70d83SChris Hudson {
269e8e70d83SChris Hudson struct kxtj9_data *tj9 = input_get_drvdata(input);
270e8e70d83SChris Hudson
271e8e70d83SChris Hudson return kxtj9_enable(tj9);
272e8e70d83SChris Hudson }
273e8e70d83SChris Hudson
kxtj9_input_close(struct input_dev * dev)274e8e70d83SChris Hudson static void kxtj9_input_close(struct input_dev *dev)
275e8e70d83SChris Hudson {
276e8e70d83SChris Hudson struct kxtj9_data *tj9 = input_get_drvdata(dev);
277e8e70d83SChris Hudson
278e8e70d83SChris Hudson kxtj9_disable(tj9);
279e8e70d83SChris Hudson }
280e8e70d83SChris Hudson
281e8e70d83SChris Hudson /*
282e8e70d83SChris Hudson * When IRQ mode is selected, we need to provide an interface to allow the user
283e8e70d83SChris Hudson * to change the output data rate of the part. For consistency, we are using
284e8e70d83SChris Hudson * the set_poll method, which accepts a poll interval in milliseconds, and then
285e8e70d83SChris Hudson * calls update_odr() while passing this value as an argument. In IRQ mode, the
286e8e70d83SChris Hudson * data outputs will not be read AT the requested poll interval, rather, the
287e8e70d83SChris Hudson * lowest ODR that can support the requested interval. The client application
288e8e70d83SChris Hudson * will be responsible for retrieving data from the input node at the desired
289e8e70d83SChris Hudson * interval.
290e8e70d83SChris Hudson */
291e8e70d83SChris Hudson
292e8e70d83SChris Hudson /* Returns currently selected poll interval (in ms) */
kxtj9_get_poll(struct device * dev,struct device_attribute * attr,char * buf)293e8e70d83SChris Hudson static ssize_t kxtj9_get_poll(struct device *dev,
294e8e70d83SChris Hudson struct device_attribute *attr, char *buf)
295e8e70d83SChris Hudson {
296e8e70d83SChris Hudson struct i2c_client *client = to_i2c_client(dev);
297e8e70d83SChris Hudson struct kxtj9_data *tj9 = i2c_get_clientdata(client);
298e8e70d83SChris Hudson
299e8e70d83SChris Hudson return sprintf(buf, "%d\n", tj9->last_poll_interval);
300e8e70d83SChris Hudson }
301e8e70d83SChris Hudson
302e8e70d83SChris Hudson /* Allow users to select a new poll interval (in ms) */
kxtj9_set_poll(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)303e8e70d83SChris Hudson static ssize_t kxtj9_set_poll(struct device *dev, struct device_attribute *attr,
304e8e70d83SChris Hudson const char *buf, size_t count)
305e8e70d83SChris Hudson {
306e8e70d83SChris Hudson struct i2c_client *client = to_i2c_client(dev);
307e8e70d83SChris Hudson struct kxtj9_data *tj9 = i2c_get_clientdata(client);
308e8e70d83SChris Hudson struct input_dev *input_dev = tj9->input_dev;
309e8e70d83SChris Hudson unsigned int interval;
310e8e70d83SChris Hudson int error;
311e8e70d83SChris Hudson
312e8e70d83SChris Hudson error = kstrtouint(buf, 10, &interval);
313e8e70d83SChris Hudson if (error < 0)
314e8e70d83SChris Hudson return error;
315e8e70d83SChris Hudson
316e8e70d83SChris Hudson /* Lock the device to prevent races with open/close (and itself) */
3176eab7ce6SDan Carpenter mutex_lock(&input_dev->mutex);
318e8e70d83SChris Hudson
319e8e70d83SChris Hudson disable_irq(client->irq);
320e8e70d83SChris Hudson
321e8e70d83SChris Hudson /*
322e8e70d83SChris Hudson * Set current interval to the greater of the minimum interval or
323e8e70d83SChris Hudson * the requested interval
324e8e70d83SChris Hudson */
325e8e70d83SChris Hudson tj9->last_poll_interval = max(interval, tj9->pdata.min_interval);
326e8e70d83SChris Hudson
327e8e70d83SChris Hudson kxtj9_update_odr(tj9, tj9->last_poll_interval);
328e8e70d83SChris Hudson
329e8e70d83SChris Hudson enable_irq(client->irq);
330e8e70d83SChris Hudson mutex_unlock(&input_dev->mutex);
331e8e70d83SChris Hudson
332e8e70d83SChris Hudson return count;
333e8e70d83SChris Hudson }
334e8e70d83SChris Hudson
335e8e70d83SChris Hudson static DEVICE_ATTR(poll, S_IRUGO|S_IWUSR, kxtj9_get_poll, kxtj9_set_poll);
336e8e70d83SChris Hudson
337e8e70d83SChris Hudson static struct attribute *kxtj9_attributes[] = {
338e8e70d83SChris Hudson &dev_attr_poll.attr,
339e8e70d83SChris Hudson NULL
340e8e70d83SChris Hudson };
341e8e70d83SChris Hudson
342e8e70d83SChris Hudson static struct attribute_group kxtj9_attribute_group = {
343e8e70d83SChris Hudson .attrs = kxtj9_attributes
344e8e70d83SChris Hudson };
345e8e70d83SChris Hudson
kxtj9_poll(struct input_dev * input)34678713dfaSDmitry Torokhov static void kxtj9_poll(struct input_dev *input)
347e8e70d83SChris Hudson {
34878713dfaSDmitry Torokhov struct kxtj9_data *tj9 = input_get_drvdata(input);
34978713dfaSDmitry Torokhov unsigned int poll_interval = input_get_poll_interval(input);
350e8e70d83SChris Hudson
351e8e70d83SChris Hudson kxtj9_report_acceleration_data(tj9);
352e8e70d83SChris Hudson
353e8e70d83SChris Hudson if (poll_interval != tj9->last_poll_interval) {
354e8e70d83SChris Hudson kxtj9_update_odr(tj9, poll_interval);
355e8e70d83SChris Hudson tj9->last_poll_interval = poll_interval;
356e8e70d83SChris Hudson }
357e8e70d83SChris Hudson }
358e8e70d83SChris Hudson
kxtj9_platform_exit(void * data)359e7339118SDmitry Torokhov static void kxtj9_platform_exit(void *data)
360e7339118SDmitry Torokhov {
361e7339118SDmitry Torokhov struct kxtj9_data *tj9 = data;
362e7339118SDmitry Torokhov
363e7339118SDmitry Torokhov if (tj9->pdata.exit)
364e7339118SDmitry Torokhov tj9->pdata.exit();
365e7339118SDmitry Torokhov }
366e7339118SDmitry Torokhov
kxtj9_verify(struct kxtj9_data * tj9)3675298cc4cSBill Pemberton static int kxtj9_verify(struct kxtj9_data *tj9)
368e8e70d83SChris Hudson {
369e8e70d83SChris Hudson int retval;
370e8e70d83SChris Hudson
371e8e70d83SChris Hudson retval = kxtj9_device_power_on(tj9);
372e8e70d83SChris Hudson if (retval < 0)
373e8e70d83SChris Hudson return retval;
374e8e70d83SChris Hudson
375e8e70d83SChris Hudson retval = i2c_smbus_read_byte_data(tj9->client, WHO_AM_I);
376e8e70d83SChris Hudson if (retval < 0) {
377e8e70d83SChris Hudson dev_err(&tj9->client->dev, "read err int source\n");
378e8e70d83SChris Hudson goto out;
379e8e70d83SChris Hudson }
380e8e70d83SChris Hudson
38104391660SChristopher Hudson retval = (retval != 0x07 && retval != 0x08) ? -EIO : 0;
382e8e70d83SChris Hudson
383e8e70d83SChris Hudson out:
384e8e70d83SChris Hudson kxtj9_device_power_off(tj9);
385e8e70d83SChris Hudson return retval;
386e8e70d83SChris Hudson }
387e8e70d83SChris Hudson
kxtj9_probe(struct i2c_client * client)388b05989d7SUwe Kleine-König static int kxtj9_probe(struct i2c_client *client)
389e8e70d83SChris Hudson {
390c838cb3dSJingoo Han const struct kxtj9_platform_data *pdata =
391c838cb3dSJingoo Han dev_get_platdata(&client->dev);
392e8e70d83SChris Hudson struct kxtj9_data *tj9;
39378713dfaSDmitry Torokhov struct input_dev *input_dev;
394e8e70d83SChris Hudson int err;
395e8e70d83SChris Hudson
396e8e70d83SChris Hudson if (!i2c_check_functionality(client->adapter,
397e8e70d83SChris Hudson I2C_FUNC_I2C | I2C_FUNC_SMBUS_BYTE_DATA)) {
398e8e70d83SChris Hudson dev_err(&client->dev, "client is not i2c capable\n");
399e8e70d83SChris Hudson return -ENXIO;
400e8e70d83SChris Hudson }
401e8e70d83SChris Hudson
402e8e70d83SChris Hudson if (!pdata) {
403e8e70d83SChris Hudson dev_err(&client->dev, "platform data is NULL; exiting\n");
404e8e70d83SChris Hudson return -EINVAL;
405e8e70d83SChris Hudson }
406e8e70d83SChris Hudson
407e7339118SDmitry Torokhov tj9 = devm_kzalloc(&client->dev, sizeof(*tj9), GFP_KERNEL);
408e8e70d83SChris Hudson if (!tj9) {
409e8e70d83SChris Hudson dev_err(&client->dev,
410e8e70d83SChris Hudson "failed to allocate memory for module data\n");
411e8e70d83SChris Hudson return -ENOMEM;
412e8e70d83SChris Hudson }
413e8e70d83SChris Hudson
414e8e70d83SChris Hudson tj9->client = client;
415e8e70d83SChris Hudson tj9->pdata = *pdata;
416e8e70d83SChris Hudson
417e8e70d83SChris Hudson if (pdata->init) {
418e8e70d83SChris Hudson err = pdata->init();
419e8e70d83SChris Hudson if (err < 0)
420e7339118SDmitry Torokhov return err;
421e8e70d83SChris Hudson }
422e8e70d83SChris Hudson
423e7339118SDmitry Torokhov err = devm_add_action_or_reset(&client->dev, kxtj9_platform_exit, tj9);
424e7339118SDmitry Torokhov if (err)
425e7339118SDmitry Torokhov return err;
426e7339118SDmitry Torokhov
427e8e70d83SChris Hudson err = kxtj9_verify(tj9);
428e8e70d83SChris Hudson if (err < 0) {
429e8e70d83SChris Hudson dev_err(&client->dev, "device not recognized\n");
430e7339118SDmitry Torokhov return err;
431e8e70d83SChris Hudson }
432e8e70d83SChris Hudson
433e8e70d83SChris Hudson i2c_set_clientdata(client, tj9);
434e8e70d83SChris Hudson
435e8e70d83SChris Hudson tj9->ctrl_reg1 = tj9->pdata.res_12bit | tj9->pdata.g_range;
43604391660SChristopher Hudson tj9->last_poll_interval = tj9->pdata.init_interval;
437e8e70d83SChris Hudson
43878713dfaSDmitry Torokhov input_dev = devm_input_allocate_device(&client->dev);
43978713dfaSDmitry Torokhov if (!input_dev) {
44078713dfaSDmitry Torokhov dev_err(&client->dev, "input device allocate failed\n");
44178713dfaSDmitry Torokhov return -ENOMEM;
44278713dfaSDmitry Torokhov }
44378713dfaSDmitry Torokhov
44478713dfaSDmitry Torokhov input_set_drvdata(input_dev, tj9);
44578713dfaSDmitry Torokhov tj9->input_dev = input_dev;
44678713dfaSDmitry Torokhov
44778713dfaSDmitry Torokhov input_dev->name = "kxtj9_accel";
44878713dfaSDmitry Torokhov input_dev->id.bustype = BUS_I2C;
44978713dfaSDmitry Torokhov
45078713dfaSDmitry Torokhov input_dev->open = kxtj9_input_open;
45178713dfaSDmitry Torokhov input_dev->close = kxtj9_input_close;
45278713dfaSDmitry Torokhov
45378713dfaSDmitry Torokhov input_set_abs_params(input_dev, ABS_X, -G_MAX, G_MAX, FUZZ, FLAT);
45478713dfaSDmitry Torokhov input_set_abs_params(input_dev, ABS_Y, -G_MAX, G_MAX, FUZZ, FLAT);
45578713dfaSDmitry Torokhov input_set_abs_params(input_dev, ABS_Z, -G_MAX, G_MAX, FUZZ, FLAT);
45678713dfaSDmitry Torokhov
45778713dfaSDmitry Torokhov if (client->irq <= 0) {
45878713dfaSDmitry Torokhov err = input_setup_polling(input_dev, kxtj9_poll);
45978713dfaSDmitry Torokhov if (err)
46078713dfaSDmitry Torokhov return err;
46178713dfaSDmitry Torokhov }
46278713dfaSDmitry Torokhov
46378713dfaSDmitry Torokhov err = input_register_device(input_dev);
46478713dfaSDmitry Torokhov if (err) {
46578713dfaSDmitry Torokhov dev_err(&client->dev,
46678713dfaSDmitry Torokhov "unable to register input polled device %s: %d\n",
46778713dfaSDmitry Torokhov input_dev->name, err);
46878713dfaSDmitry Torokhov return err;
46978713dfaSDmitry Torokhov }
47078713dfaSDmitry Torokhov
471e8e70d83SChris Hudson if (client->irq) {
472e8e70d83SChris Hudson /* If in irq mode, populate INT_CTRL_REG1 and enable DRDY. */
473e8e70d83SChris Hudson tj9->int_ctrl |= KXTJ9_IEN | KXTJ9_IEA | KXTJ9_IEL;
474e8e70d83SChris Hudson tj9->ctrl_reg1 |= DRDYE;
475e8e70d83SChris Hudson
476e7339118SDmitry Torokhov err = devm_request_threaded_irq(&client->dev, client->irq,
477e7339118SDmitry Torokhov NULL, kxtj9_isr,
478e7339118SDmitry Torokhov IRQF_TRIGGER_RISING |
479e7339118SDmitry Torokhov IRQF_ONESHOT,
480e8e70d83SChris Hudson "kxtj9-irq", tj9);
481e8e70d83SChris Hudson if (err) {
482e8e70d83SChris Hudson dev_err(&client->dev, "request irq failed: %d\n", err);
483e7339118SDmitry Torokhov return err;
484e8e70d83SChris Hudson }
485e8e70d83SChris Hudson
486e7339118SDmitry Torokhov err = devm_device_add_group(&client->dev,
487e7339118SDmitry Torokhov &kxtj9_attribute_group);
488e8e70d83SChris Hudson if (err) {
489e8e70d83SChris Hudson dev_err(&client->dev, "sysfs create failed: %d\n", err);
490e7339118SDmitry Torokhov return err;
491e8e70d83SChris Hudson }
492e8e70d83SChris Hudson }
493e8e70d83SChris Hudson
494e8e70d83SChris Hudson return 0;
495e8e70d83SChris Hudson }
496e8e70d83SChris Hudson
kxtj9_suspend(struct device * dev)4970ac787e0SJonathan Cameron static int kxtj9_suspend(struct device *dev)
498e8e70d83SChris Hudson {
499e8e70d83SChris Hudson struct i2c_client *client = to_i2c_client(dev);
500e8e70d83SChris Hudson struct kxtj9_data *tj9 = i2c_get_clientdata(client);
501e8e70d83SChris Hudson struct input_dev *input_dev = tj9->input_dev;
502e8e70d83SChris Hudson
503e8e70d83SChris Hudson mutex_lock(&input_dev->mutex);
504e8e70d83SChris Hudson
505d69f0a43SAndrzej Pietrasiewicz if (input_device_enabled(input_dev))
506e8e70d83SChris Hudson kxtj9_disable(tj9);
507e8e70d83SChris Hudson
508e8e70d83SChris Hudson mutex_unlock(&input_dev->mutex);
509e8e70d83SChris Hudson return 0;
510e8e70d83SChris Hudson }
511e8e70d83SChris Hudson
kxtj9_resume(struct device * dev)5120ac787e0SJonathan Cameron static int kxtj9_resume(struct device *dev)
513e8e70d83SChris Hudson {
514e8e70d83SChris Hudson struct i2c_client *client = to_i2c_client(dev);
515e8e70d83SChris Hudson struct kxtj9_data *tj9 = i2c_get_clientdata(client);
516e8e70d83SChris Hudson struct input_dev *input_dev = tj9->input_dev;
517e8e70d83SChris Hudson
518e8e70d83SChris Hudson mutex_lock(&input_dev->mutex);
519e8e70d83SChris Hudson
520d69f0a43SAndrzej Pietrasiewicz if (input_device_enabled(input_dev))
521e8e70d83SChris Hudson kxtj9_enable(tj9);
522e8e70d83SChris Hudson
523e8e70d83SChris Hudson mutex_unlock(&input_dev->mutex);
5245ccd9abdSJavier Martinez Canillas return 0;
525e8e70d83SChris Hudson }
526e8e70d83SChris Hudson
5270ac787e0SJonathan Cameron static DEFINE_SIMPLE_DEV_PM_OPS(kxtj9_pm_ops, kxtj9_suspend, kxtj9_resume);
528e8e70d83SChris Hudson
529e8e70d83SChris Hudson static const struct i2c_device_id kxtj9_id[] = {
530e8e70d83SChris Hudson { NAME, 0 },
531e8e70d83SChris Hudson { },
532e8e70d83SChris Hudson };
533e8e70d83SChris Hudson
534e8e70d83SChris Hudson MODULE_DEVICE_TABLE(i2c, kxtj9_id);
535e8e70d83SChris Hudson
536e8e70d83SChris Hudson static struct i2c_driver kxtj9_driver = {
537e8e70d83SChris Hudson .driver = {
538e8e70d83SChris Hudson .name = NAME,
5390ac787e0SJonathan Cameron .pm = pm_sleep_ptr(&kxtj9_pm_ops),
540e8e70d83SChris Hudson },
541*d8bde56dSUwe Kleine-König .probe = kxtj9_probe,
542e8e70d83SChris Hudson .id_table = kxtj9_id,
543e8e70d83SChris Hudson };
544e8e70d83SChris Hudson
5451b92c1cfSAxel Lin module_i2c_driver(kxtj9_driver);
546e8e70d83SChris Hudson
547e8e70d83SChris Hudson MODULE_DESCRIPTION("KXTJ9 accelerometer driver");
548e8e70d83SChris Hudson MODULE_AUTHOR("Chris Hudson <chudson@kionix.com>");
549e8e70d83SChris Hudson MODULE_LICENSE("GPL");
550