180503b23SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
2e27c7292SMichael Hennerich /*
3e27c7292SMichael Hennerich * ADXL345/346 Three-Axis Digital Accelerometers
4e27c7292SMichael Hennerich *
5e27c7292SMichael Hennerich * Enter bugs at http://blackfin.uclinux.org/
6e27c7292SMichael Hennerich *
7e27c7292SMichael Hennerich * Copyright (C) 2009 Michael Hennerich, Analog Devices Inc.
8e27c7292SMichael Hennerich */
9e27c7292SMichael Hennerich
10e27c7292SMichael Hennerich #include <linux/device.h>
11e27c7292SMichael Hennerich #include <linux/delay.h>
12e27c7292SMichael Hennerich #include <linux/input.h>
13e27c7292SMichael Hennerich #include <linux/interrupt.h>
14e27c7292SMichael Hennerich #include <linux/irq.h>
15e27c7292SMichael Hennerich #include <linux/slab.h>
16e27c7292SMichael Hennerich #include <linux/workqueue.h>
17e27c7292SMichael Hennerich #include <linux/input/adxl34x.h>
18d2d8442dSPaul Gortmaker #include <linux/module.h>
19e27c7292SMichael Hennerich
20e27c7292SMichael Hennerich #include "adxl34x.h"
21e27c7292SMichael Hennerich
22e27c7292SMichael Hennerich /* ADXL345/6 Register Map */
23e27c7292SMichael Hennerich #define DEVID 0x00 /* R Device ID */
24e27c7292SMichael Hennerich #define THRESH_TAP 0x1D /* R/W Tap threshold */
25e27c7292SMichael Hennerich #define OFSX 0x1E /* R/W X-axis offset */
26e27c7292SMichael Hennerich #define OFSY 0x1F /* R/W Y-axis offset */
27e27c7292SMichael Hennerich #define OFSZ 0x20 /* R/W Z-axis offset */
28e27c7292SMichael Hennerich #define DUR 0x21 /* R/W Tap duration */
29e27c7292SMichael Hennerich #define LATENT 0x22 /* R/W Tap latency */
30e27c7292SMichael Hennerich #define WINDOW 0x23 /* R/W Tap window */
31e27c7292SMichael Hennerich #define THRESH_ACT 0x24 /* R/W Activity threshold */
32e27c7292SMichael Hennerich #define THRESH_INACT 0x25 /* R/W Inactivity threshold */
33e27c7292SMichael Hennerich #define TIME_INACT 0x26 /* R/W Inactivity time */
34e27c7292SMichael Hennerich #define ACT_INACT_CTL 0x27 /* R/W Axis enable control for activity and */
35e27c7292SMichael Hennerich /* inactivity detection */
36e27c7292SMichael Hennerich #define THRESH_FF 0x28 /* R/W Free-fall threshold */
37e27c7292SMichael Hennerich #define TIME_FF 0x29 /* R/W Free-fall time */
38e27c7292SMichael Hennerich #define TAP_AXES 0x2A /* R/W Axis control for tap/double tap */
39e27c7292SMichael Hennerich #define ACT_TAP_STATUS 0x2B /* R Source of tap/double tap */
40e27c7292SMichael Hennerich #define BW_RATE 0x2C /* R/W Data rate and power mode control */
41e27c7292SMichael Hennerich #define POWER_CTL 0x2D /* R/W Power saving features control */
42e27c7292SMichael Hennerich #define INT_ENABLE 0x2E /* R/W Interrupt enable control */
43e27c7292SMichael Hennerich #define INT_MAP 0x2F /* R/W Interrupt mapping control */
44e27c7292SMichael Hennerich #define INT_SOURCE 0x30 /* R Source of interrupts */
45e27c7292SMichael Hennerich #define DATA_FORMAT 0x31 /* R/W Data format control */
46e27c7292SMichael Hennerich #define DATAX0 0x32 /* R X-Axis Data 0 */
47e27c7292SMichael Hennerich #define DATAX1 0x33 /* R X-Axis Data 1 */
48e27c7292SMichael Hennerich #define DATAY0 0x34 /* R Y-Axis Data 0 */
49e27c7292SMichael Hennerich #define DATAY1 0x35 /* R Y-Axis Data 1 */
50e27c7292SMichael Hennerich #define DATAZ0 0x36 /* R Z-Axis Data 0 */
51e27c7292SMichael Hennerich #define DATAZ1 0x37 /* R Z-Axis Data 1 */
52e27c7292SMichael Hennerich #define FIFO_CTL 0x38 /* R/W FIFO control */
53e27c7292SMichael Hennerich #define FIFO_STATUS 0x39 /* R FIFO status */
54e27c7292SMichael Hennerich #define TAP_SIGN 0x3A /* R Sign and source for tap/double tap */
55e27c7292SMichael Hennerich /* Orientation ADXL346 only */
56e27c7292SMichael Hennerich #define ORIENT_CONF 0x3B /* R/W Orientation configuration */
57e27c7292SMichael Hennerich #define ORIENT 0x3C /* R Orientation status */
58e27c7292SMichael Hennerich
59e27c7292SMichael Hennerich /* DEVIDs */
60e27c7292SMichael Hennerich #define ID_ADXL345 0xE5
61e27c7292SMichael Hennerich #define ID_ADXL346 0xE6
62e27c7292SMichael Hennerich
63e27c7292SMichael Hennerich /* INT_ENABLE/INT_MAP/INT_SOURCE Bits */
64e27c7292SMichael Hennerich #define DATA_READY (1 << 7)
65e27c7292SMichael Hennerich #define SINGLE_TAP (1 << 6)
66e27c7292SMichael Hennerich #define DOUBLE_TAP (1 << 5)
67e27c7292SMichael Hennerich #define ACTIVITY (1 << 4)
68e27c7292SMichael Hennerich #define INACTIVITY (1 << 3)
69e27c7292SMichael Hennerich #define FREE_FALL (1 << 2)
70e27c7292SMichael Hennerich #define WATERMARK (1 << 1)
71e27c7292SMichael Hennerich #define OVERRUN (1 << 0)
72e27c7292SMichael Hennerich
73e27c7292SMichael Hennerich /* ACT_INACT_CONTROL Bits */
74e27c7292SMichael Hennerich #define ACT_ACDC (1 << 7)
75e27c7292SMichael Hennerich #define ACT_X_EN (1 << 6)
76e27c7292SMichael Hennerich #define ACT_Y_EN (1 << 5)
77e27c7292SMichael Hennerich #define ACT_Z_EN (1 << 4)
78e27c7292SMichael Hennerich #define INACT_ACDC (1 << 3)
79e27c7292SMichael Hennerich #define INACT_X_EN (1 << 2)
80e27c7292SMichael Hennerich #define INACT_Y_EN (1 << 1)
81e27c7292SMichael Hennerich #define INACT_Z_EN (1 << 0)
82e27c7292SMichael Hennerich
83e27c7292SMichael Hennerich /* TAP_AXES Bits */
84e27c7292SMichael Hennerich #define SUPPRESS (1 << 3)
85e27c7292SMichael Hennerich #define TAP_X_EN (1 << 2)
86e27c7292SMichael Hennerich #define TAP_Y_EN (1 << 1)
87e27c7292SMichael Hennerich #define TAP_Z_EN (1 << 0)
88e27c7292SMichael Hennerich
89e27c7292SMichael Hennerich /* ACT_TAP_STATUS Bits */
90e27c7292SMichael Hennerich #define ACT_X_SRC (1 << 6)
91e27c7292SMichael Hennerich #define ACT_Y_SRC (1 << 5)
92e27c7292SMichael Hennerich #define ACT_Z_SRC (1 << 4)
93e27c7292SMichael Hennerich #define ASLEEP (1 << 3)
94e27c7292SMichael Hennerich #define TAP_X_SRC (1 << 2)
95e27c7292SMichael Hennerich #define TAP_Y_SRC (1 << 1)
96e27c7292SMichael Hennerich #define TAP_Z_SRC (1 << 0)
97e27c7292SMichael Hennerich
98e27c7292SMichael Hennerich /* BW_RATE Bits */
99e27c7292SMichael Hennerich #define LOW_POWER (1 << 4)
100e27c7292SMichael Hennerich #define RATE(x) ((x) & 0xF)
101e27c7292SMichael Hennerich
102e27c7292SMichael Hennerich /* POWER_CTL Bits */
103e27c7292SMichael Hennerich #define PCTL_LINK (1 << 5)
104e27c7292SMichael Hennerich #define PCTL_AUTO_SLEEP (1 << 4)
105e27c7292SMichael Hennerich #define PCTL_MEASURE (1 << 3)
106e27c7292SMichael Hennerich #define PCTL_SLEEP (1 << 2)
107e27c7292SMichael Hennerich #define PCTL_WAKEUP(x) ((x) & 0x3)
108e27c7292SMichael Hennerich
109e27c7292SMichael Hennerich /* DATA_FORMAT Bits */
110e27c7292SMichael Hennerich #define SELF_TEST (1 << 7)
111e27c7292SMichael Hennerich #define SPI (1 << 6)
112e27c7292SMichael Hennerich #define INT_INVERT (1 << 5)
113e27c7292SMichael Hennerich #define FULL_RES (1 << 3)
114e27c7292SMichael Hennerich #define JUSTIFY (1 << 2)
115e27c7292SMichael Hennerich #define RANGE(x) ((x) & 0x3)
116e27c7292SMichael Hennerich #define RANGE_PM_2g 0
117e27c7292SMichael Hennerich #define RANGE_PM_4g 1
118e27c7292SMichael Hennerich #define RANGE_PM_8g 2
119e27c7292SMichael Hennerich #define RANGE_PM_16g 3
120e27c7292SMichael Hennerich
121e27c7292SMichael Hennerich /*
122e27c7292SMichael Hennerich * Maximum value our axis may get in full res mode for the input device
123e27c7292SMichael Hennerich * (signed 13 bits)
124e27c7292SMichael Hennerich */
125e27c7292SMichael Hennerich #define ADXL_FULLRES_MAX_VAL 4096
126e27c7292SMichael Hennerich
127e27c7292SMichael Hennerich /*
128e27c7292SMichael Hennerich * Maximum value our axis may get in fixed res mode for the input device
129e27c7292SMichael Hennerich * (signed 10 bits)
130e27c7292SMichael Hennerich */
131e27c7292SMichael Hennerich #define ADXL_FIXEDRES_MAX_VAL 512
132e27c7292SMichael Hennerich
133e27c7292SMichael Hennerich /* FIFO_CTL Bits */
134e27c7292SMichael Hennerich #define FIFO_MODE(x) (((x) & 0x3) << 6)
135e27c7292SMichael Hennerich #define FIFO_BYPASS 0
136e27c7292SMichael Hennerich #define FIFO_FIFO 1
137e27c7292SMichael Hennerich #define FIFO_STREAM 2
138e27c7292SMichael Hennerich #define FIFO_TRIGGER 3
139e27c7292SMichael Hennerich #define TRIGGER (1 << 5)
140e27c7292SMichael Hennerich #define SAMPLES(x) ((x) & 0x1F)
141e27c7292SMichael Hennerich
142e27c7292SMichael Hennerich /* FIFO_STATUS Bits */
143e27c7292SMichael Hennerich #define FIFO_TRIG (1 << 7)
144e27c7292SMichael Hennerich #define ENTRIES(x) ((x) & 0x3F)
145e27c7292SMichael Hennerich
146e27c7292SMichael Hennerich /* TAP_SIGN Bits ADXL346 only */
147e27c7292SMichael Hennerich #define XSIGN (1 << 6)
148e27c7292SMichael Hennerich #define YSIGN (1 << 5)
149e27c7292SMichael Hennerich #define ZSIGN (1 << 4)
150e27c7292SMichael Hennerich #define XTAP (1 << 3)
151e27c7292SMichael Hennerich #define YTAP (1 << 2)
152e27c7292SMichael Hennerich #define ZTAP (1 << 1)
153e27c7292SMichael Hennerich
154e27c7292SMichael Hennerich /* ORIENT_CONF ADXL346 only */
155e27c7292SMichael Hennerich #define ORIENT_DEADZONE(x) (((x) & 0x7) << 4)
156e27c7292SMichael Hennerich #define ORIENT_DIVISOR(x) ((x) & 0x7)
157e27c7292SMichael Hennerich
158e27c7292SMichael Hennerich /* ORIENT ADXL346 only */
159e27c7292SMichael Hennerich #define ADXL346_2D_VALID (1 << 6)
160241ecf1cSMichael Hennerich #define ADXL346_2D_ORIENT(x) (((x) & 0x30) >> 4)
161e27c7292SMichael Hennerich #define ADXL346_3D_VALID (1 << 3)
162e27c7292SMichael Hennerich #define ADXL346_3D_ORIENT(x) ((x) & 0x7)
163e27c7292SMichael Hennerich #define ADXL346_2D_PORTRAIT_POS 0 /* +X */
164e27c7292SMichael Hennerich #define ADXL346_2D_PORTRAIT_NEG 1 /* -X */
165e27c7292SMichael Hennerich #define ADXL346_2D_LANDSCAPE_POS 2 /* +Y */
166e27c7292SMichael Hennerich #define ADXL346_2D_LANDSCAPE_NEG 3 /* -Y */
167e27c7292SMichael Hennerich
168e27c7292SMichael Hennerich #define ADXL346_3D_FRONT 3 /* +X */
169e27c7292SMichael Hennerich #define ADXL346_3D_BACK 4 /* -X */
170e27c7292SMichael Hennerich #define ADXL346_3D_RIGHT 2 /* +Y */
171e27c7292SMichael Hennerich #define ADXL346_3D_LEFT 5 /* -Y */
172e27c7292SMichael Hennerich #define ADXL346_3D_TOP 1 /* +Z */
173e27c7292SMichael Hennerich #define ADXL346_3D_BOTTOM 6 /* -Z */
174e27c7292SMichael Hennerich
175e27c7292SMichael Hennerich #undef ADXL_DEBUG
176e27c7292SMichael Hennerich
177e27c7292SMichael Hennerich #define ADXL_X_AXIS 0
178e27c7292SMichael Hennerich #define ADXL_Y_AXIS 1
179e27c7292SMichael Hennerich #define ADXL_Z_AXIS 2
180e27c7292SMichael Hennerich
181e27c7292SMichael Hennerich #define AC_READ(ac, reg) ((ac)->bops->read((ac)->dev, reg))
182e27c7292SMichael Hennerich #define AC_WRITE(ac, reg, val) ((ac)->bops->write((ac)->dev, reg, val))
183e27c7292SMichael Hennerich
184e27c7292SMichael Hennerich struct axis_triple {
185e27c7292SMichael Hennerich int x;
186e27c7292SMichael Hennerich int y;
187e27c7292SMichael Hennerich int z;
188e27c7292SMichael Hennerich };
189e27c7292SMichael Hennerich
190e27c7292SMichael Hennerich struct adxl34x {
191e27c7292SMichael Hennerich struct device *dev;
192e27c7292SMichael Hennerich struct input_dev *input;
193e27c7292SMichael Hennerich struct mutex mutex; /* reentrant protection for struct */
194e27c7292SMichael Hennerich struct adxl34x_platform_data pdata;
195e27c7292SMichael Hennerich struct axis_triple swcal;
196e27c7292SMichael Hennerich struct axis_triple hwcal;
197e27c7292SMichael Hennerich struct axis_triple saved;
198e27c7292SMichael Hennerich char phys[32];
199671386bbSMichael Hennerich unsigned orient2d_saved;
200671386bbSMichael Hennerich unsigned orient3d_saved;
201e27c7292SMichael Hennerich bool disabled; /* P: mutex */
202e27c7292SMichael Hennerich bool opened; /* P: mutex */
203af6e1d99SDmitry Torokhov bool suspended; /* P: mutex */
204e27c7292SMichael Hennerich bool fifo_delay;
205e27c7292SMichael Hennerich int irq;
206e27c7292SMichael Hennerich unsigned model;
207e27c7292SMichael Hennerich unsigned int_mask;
208e27c7292SMichael Hennerich
209e27c7292SMichael Hennerich const struct adxl34x_bus_ops *bops;
210e27c7292SMichael Hennerich };
211e27c7292SMichael Hennerich
212e27c7292SMichael Hennerich static const struct adxl34x_platform_data adxl34x_default_init = {
213e27c7292SMichael Hennerich .tap_threshold = 35,
214e27c7292SMichael Hennerich .tap_duration = 3,
215e27c7292SMichael Hennerich .tap_latency = 20,
216e27c7292SMichael Hennerich .tap_window = 20,
217e27c7292SMichael Hennerich .tap_axis_control = ADXL_TAP_X_EN | ADXL_TAP_Y_EN | ADXL_TAP_Z_EN,
218e27c7292SMichael Hennerich .act_axis_control = 0xFF,
219e27c7292SMichael Hennerich .activity_threshold = 6,
220e27c7292SMichael Hennerich .inactivity_threshold = 4,
221e27c7292SMichael Hennerich .inactivity_time = 3,
222e27c7292SMichael Hennerich .free_fall_threshold = 8,
223e27c7292SMichael Hennerich .free_fall_time = 0x20,
224e27c7292SMichael Hennerich .data_rate = 8,
225e27c7292SMichael Hennerich .data_range = ADXL_FULL_RES,
226e27c7292SMichael Hennerich
227e27c7292SMichael Hennerich .ev_type = EV_ABS,
228e27c7292SMichael Hennerich .ev_code_x = ABS_X, /* EV_REL */
229e27c7292SMichael Hennerich .ev_code_y = ABS_Y, /* EV_REL */
230e27c7292SMichael Hennerich .ev_code_z = ABS_Z, /* EV_REL */
231e27c7292SMichael Hennerich
232e27c7292SMichael Hennerich .ev_code_tap = {BTN_TOUCH, BTN_TOUCH, BTN_TOUCH}, /* EV_KEY {x,y,z} */
233e27c7292SMichael Hennerich .power_mode = ADXL_AUTO_SLEEP | ADXL_LINK,
23403c86ee1SWolfram Sang .fifo_mode = ADXL_FIFO_STREAM,
235e27c7292SMichael Hennerich .watermark = 0,
236e27c7292SMichael Hennerich };
237e27c7292SMichael Hennerich
adxl34x_get_triple(struct adxl34x * ac,struct axis_triple * axis)238e27c7292SMichael Hennerich static void adxl34x_get_triple(struct adxl34x *ac, struct axis_triple *axis)
239e27c7292SMichael Hennerich {
240804f354aSDmitry Torokhov __le16 buf[3];
241e27c7292SMichael Hennerich
242e27c7292SMichael Hennerich ac->bops->read_block(ac->dev, DATAX0, DATAZ1 - DATAX0 + 1, buf);
243e27c7292SMichael Hennerich
244e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
245e27c7292SMichael Hennerich ac->saved.x = (s16) le16_to_cpu(buf[0]);
246e27c7292SMichael Hennerich axis->x = ac->saved.x;
247e27c7292SMichael Hennerich
248e27c7292SMichael Hennerich ac->saved.y = (s16) le16_to_cpu(buf[1]);
249e27c7292SMichael Hennerich axis->y = ac->saved.y;
250e27c7292SMichael Hennerich
251e27c7292SMichael Hennerich ac->saved.z = (s16) le16_to_cpu(buf[2]);
252e27c7292SMichael Hennerich axis->z = ac->saved.z;
253e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
254e27c7292SMichael Hennerich }
255e27c7292SMichael Hennerich
adxl34x_service_ev_fifo(struct adxl34x * ac)256e27c7292SMichael Hennerich static void adxl34x_service_ev_fifo(struct adxl34x *ac)
257e27c7292SMichael Hennerich {
258e27c7292SMichael Hennerich struct adxl34x_platform_data *pdata = &ac->pdata;
259e27c7292SMichael Hennerich struct axis_triple axis;
260e27c7292SMichael Hennerich
261e27c7292SMichael Hennerich adxl34x_get_triple(ac, &axis);
262e27c7292SMichael Hennerich
263e27c7292SMichael Hennerich input_event(ac->input, pdata->ev_type, pdata->ev_code_x,
264e27c7292SMichael Hennerich axis.x - ac->swcal.x);
265e27c7292SMichael Hennerich input_event(ac->input, pdata->ev_type, pdata->ev_code_y,
266e27c7292SMichael Hennerich axis.y - ac->swcal.y);
267e27c7292SMichael Hennerich input_event(ac->input, pdata->ev_type, pdata->ev_code_z,
268e27c7292SMichael Hennerich axis.z - ac->swcal.z);
269e27c7292SMichael Hennerich }
270e27c7292SMichael Hennerich
adxl34x_report_key_single(struct input_dev * input,int key)271e27c7292SMichael Hennerich static void adxl34x_report_key_single(struct input_dev *input, int key)
272e27c7292SMichael Hennerich {
273e27c7292SMichael Hennerich input_report_key(input, key, true);
274e27c7292SMichael Hennerich input_sync(input);
275e27c7292SMichael Hennerich input_report_key(input, key, false);
276e27c7292SMichael Hennerich }
277e27c7292SMichael Hennerich
adxl34x_send_key_events(struct adxl34x * ac,struct adxl34x_platform_data * pdata,int status,int press)278e27c7292SMichael Hennerich static void adxl34x_send_key_events(struct adxl34x *ac,
279e27c7292SMichael Hennerich struct adxl34x_platform_data *pdata, int status, int press)
280e27c7292SMichael Hennerich {
281e27c7292SMichael Hennerich int i;
282e27c7292SMichael Hennerich
283e27c7292SMichael Hennerich for (i = ADXL_X_AXIS; i <= ADXL_Z_AXIS; i++) {
284e27c7292SMichael Hennerich if (status & (1 << (ADXL_Z_AXIS - i)))
285e27c7292SMichael Hennerich input_report_key(ac->input,
286e27c7292SMichael Hennerich pdata->ev_code_tap[i], press);
287e27c7292SMichael Hennerich }
288e27c7292SMichael Hennerich }
289e27c7292SMichael Hennerich
adxl34x_do_tap(struct adxl34x * ac,struct adxl34x_platform_data * pdata,int status)290e27c7292SMichael Hennerich static void adxl34x_do_tap(struct adxl34x *ac,
291e27c7292SMichael Hennerich struct adxl34x_platform_data *pdata, int status)
292e27c7292SMichael Hennerich {
293e27c7292SMichael Hennerich adxl34x_send_key_events(ac, pdata, status, true);
294e27c7292SMichael Hennerich input_sync(ac->input);
295e27c7292SMichael Hennerich adxl34x_send_key_events(ac, pdata, status, false);
296e27c7292SMichael Hennerich }
297e27c7292SMichael Hennerich
adxl34x_irq(int irq,void * handle)298e27c7292SMichael Hennerich static irqreturn_t adxl34x_irq(int irq, void *handle)
299e27c7292SMichael Hennerich {
300e27c7292SMichael Hennerich struct adxl34x *ac = handle;
301e27c7292SMichael Hennerich struct adxl34x_platform_data *pdata = &ac->pdata;
302671386bbSMichael Hennerich int int_stat, tap_stat, samples, orient, orient_code;
303e27c7292SMichael Hennerich
304e27c7292SMichael Hennerich /*
305e27c7292SMichael Hennerich * ACT_TAP_STATUS should be read before clearing the interrupt
306e27c7292SMichael Hennerich * Avoid reading ACT_TAP_STATUS in case TAP detection is disabled
307e27c7292SMichael Hennerich */
308e27c7292SMichael Hennerich
309e27c7292SMichael Hennerich if (pdata->tap_axis_control & (TAP_X_EN | TAP_Y_EN | TAP_Z_EN))
310e27c7292SMichael Hennerich tap_stat = AC_READ(ac, ACT_TAP_STATUS);
311e27c7292SMichael Hennerich else
312e27c7292SMichael Hennerich tap_stat = 0;
313e27c7292SMichael Hennerich
314e27c7292SMichael Hennerich int_stat = AC_READ(ac, INT_SOURCE);
315e27c7292SMichael Hennerich
316e27c7292SMichael Hennerich if (int_stat & FREE_FALL)
317e27c7292SMichael Hennerich adxl34x_report_key_single(ac->input, pdata->ev_code_ff);
318e27c7292SMichael Hennerich
319e27c7292SMichael Hennerich if (int_stat & OVERRUN)
320e27c7292SMichael Hennerich dev_dbg(ac->dev, "OVERRUN\n");
321e27c7292SMichael Hennerich
322e27c7292SMichael Hennerich if (int_stat & (SINGLE_TAP | DOUBLE_TAP)) {
323e27c7292SMichael Hennerich adxl34x_do_tap(ac, pdata, tap_stat);
324e27c7292SMichael Hennerich
325e27c7292SMichael Hennerich if (int_stat & DOUBLE_TAP)
326e27c7292SMichael Hennerich adxl34x_do_tap(ac, pdata, tap_stat);
327e27c7292SMichael Hennerich }
328e27c7292SMichael Hennerich
329e27c7292SMichael Hennerich if (pdata->ev_code_act_inactivity) {
330e27c7292SMichael Hennerich if (int_stat & ACTIVITY)
331e27c7292SMichael Hennerich input_report_key(ac->input,
332e27c7292SMichael Hennerich pdata->ev_code_act_inactivity, 1);
333e27c7292SMichael Hennerich if (int_stat & INACTIVITY)
334e27c7292SMichael Hennerich input_report_key(ac->input,
335e27c7292SMichael Hennerich pdata->ev_code_act_inactivity, 0);
336e27c7292SMichael Hennerich }
337e27c7292SMichael Hennerich
338671386bbSMichael Hennerich /*
339671386bbSMichael Hennerich * ORIENTATION SENSING ADXL346 only
340671386bbSMichael Hennerich */
341671386bbSMichael Hennerich if (pdata->orientation_enable) {
342671386bbSMichael Hennerich orient = AC_READ(ac, ORIENT);
343671386bbSMichael Hennerich if ((pdata->orientation_enable & ADXL_EN_ORIENTATION_2D) &&
344671386bbSMichael Hennerich (orient & ADXL346_2D_VALID)) {
345671386bbSMichael Hennerich
346671386bbSMichael Hennerich orient_code = ADXL346_2D_ORIENT(orient);
347671386bbSMichael Hennerich /* Report orientation only when it changes */
348671386bbSMichael Hennerich if (ac->orient2d_saved != orient_code) {
349671386bbSMichael Hennerich ac->orient2d_saved = orient_code;
350671386bbSMichael Hennerich adxl34x_report_key_single(ac->input,
351671386bbSMichael Hennerich pdata->ev_codes_orient_2d[orient_code]);
352671386bbSMichael Hennerich }
353671386bbSMichael Hennerich }
354671386bbSMichael Hennerich
355671386bbSMichael Hennerich if ((pdata->orientation_enable & ADXL_EN_ORIENTATION_3D) &&
356671386bbSMichael Hennerich (orient & ADXL346_3D_VALID)) {
357671386bbSMichael Hennerich
358671386bbSMichael Hennerich orient_code = ADXL346_3D_ORIENT(orient) - 1;
359671386bbSMichael Hennerich /* Report orientation only when it changes */
360671386bbSMichael Hennerich if (ac->orient3d_saved != orient_code) {
361671386bbSMichael Hennerich ac->orient3d_saved = orient_code;
362671386bbSMichael Hennerich adxl34x_report_key_single(ac->input,
363671386bbSMichael Hennerich pdata->ev_codes_orient_3d[orient_code]);
364671386bbSMichael Hennerich }
365671386bbSMichael Hennerich }
366671386bbSMichael Hennerich }
367671386bbSMichael Hennerich
368e27c7292SMichael Hennerich if (int_stat & (DATA_READY | WATERMARK)) {
369e27c7292SMichael Hennerich
370e27c7292SMichael Hennerich if (pdata->fifo_mode)
371e27c7292SMichael Hennerich samples = ENTRIES(AC_READ(ac, FIFO_STATUS)) + 1;
372e27c7292SMichael Hennerich else
373e27c7292SMichael Hennerich samples = 1;
374e27c7292SMichael Hennerich
375e27c7292SMichael Hennerich for (; samples > 0; samples--) {
376e27c7292SMichael Hennerich adxl34x_service_ev_fifo(ac);
377e27c7292SMichael Hennerich /*
378e27c7292SMichael Hennerich * To ensure that the FIFO has
379e27c7292SMichael Hennerich * completely popped, there must be at least 5 us between
380e27c7292SMichael Hennerich * the end of reading the data registers, signified by the
381e27c7292SMichael Hennerich * transition to register 0x38 from 0x37 or the CS pin
382e27c7292SMichael Hennerich * going high, and the start of new reads of the FIFO or
383e27c7292SMichael Hennerich * reading the FIFO_STATUS register. For SPI operation at
384e27c7292SMichael Hennerich * 1.5 MHz or lower, the register addressing portion of the
385e27c7292SMichael Hennerich * transmission is sufficient delay to ensure the FIFO has
386e27c7292SMichael Hennerich * completely popped. It is necessary for SPI operation
387e27c7292SMichael Hennerich * greater than 1.5 MHz to de-assert the CS pin to ensure a
388e27c7292SMichael Hennerich * total of 5 us, which is at most 3.4 us at 5 MHz
389e27c7292SMichael Hennerich * operation.
390e27c7292SMichael Hennerich */
391e27c7292SMichael Hennerich if (ac->fifo_delay && (samples > 1))
392e27c7292SMichael Hennerich udelay(3);
393e27c7292SMichael Hennerich }
394e27c7292SMichael Hennerich }
395e27c7292SMichael Hennerich
396e27c7292SMichael Hennerich input_sync(ac->input);
397e27c7292SMichael Hennerich
398e27c7292SMichael Hennerich return IRQ_HANDLED;
399e27c7292SMichael Hennerich }
400e27c7292SMichael Hennerich
__adxl34x_disable(struct adxl34x * ac)401e27c7292SMichael Hennerich static void __adxl34x_disable(struct adxl34x *ac)
402e27c7292SMichael Hennerich {
403e27c7292SMichael Hennerich /*
404e27c7292SMichael Hennerich * A '0' places the ADXL34x into standby mode
405e27c7292SMichael Hennerich * with minimum power consumption.
406e27c7292SMichael Hennerich */
407e27c7292SMichael Hennerich AC_WRITE(ac, POWER_CTL, 0);
408e27c7292SMichael Hennerich }
409e27c7292SMichael Hennerich
__adxl34x_enable(struct adxl34x * ac)410e27c7292SMichael Hennerich static void __adxl34x_enable(struct adxl34x *ac)
411e27c7292SMichael Hennerich {
412e27c7292SMichael Hennerich AC_WRITE(ac, POWER_CTL, ac->pdata.power_mode | PCTL_MEASURE);
413e27c7292SMichael Hennerich }
414e27c7292SMichael Hennerich
adxl34x_suspend(struct device * dev)41540be0646SJonathan Cameron static int adxl34x_suspend(struct device *dev)
416e27c7292SMichael Hennerich {
41740be0646SJonathan Cameron struct adxl34x *ac = dev_get_drvdata(dev);
41840be0646SJonathan Cameron
419e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
420af6e1d99SDmitry Torokhov
421af6e1d99SDmitry Torokhov if (!ac->suspended && !ac->disabled && ac->opened)
422e27c7292SMichael Hennerich __adxl34x_disable(ac);
423af6e1d99SDmitry Torokhov
424af6e1d99SDmitry Torokhov ac->suspended = true;
425af6e1d99SDmitry Torokhov
426e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
427e27c7292SMichael Hennerich
42840be0646SJonathan Cameron return 0;
42940be0646SJonathan Cameron }
43040be0646SJonathan Cameron
adxl34x_resume(struct device * dev)43140be0646SJonathan Cameron static int adxl34x_resume(struct device *dev)
432e27c7292SMichael Hennerich {
43340be0646SJonathan Cameron struct adxl34x *ac = dev_get_drvdata(dev);
43440be0646SJonathan Cameron
435e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
436af6e1d99SDmitry Torokhov
437af6e1d99SDmitry Torokhov if (ac->suspended && !ac->disabled && ac->opened)
438e27c7292SMichael Hennerich __adxl34x_enable(ac);
439af6e1d99SDmitry Torokhov
440af6e1d99SDmitry Torokhov ac->suspended = false;
441af6e1d99SDmitry Torokhov
442e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
44340be0646SJonathan Cameron
44440be0646SJonathan Cameron return 0;
445e27c7292SMichael Hennerich }
446e27c7292SMichael Hennerich
adxl34x_disable_show(struct device * dev,struct device_attribute * attr,char * buf)447e27c7292SMichael Hennerich static ssize_t adxl34x_disable_show(struct device *dev,
448e27c7292SMichael Hennerich struct device_attribute *attr, char *buf)
449e27c7292SMichael Hennerich {
450e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev);
451e27c7292SMichael Hennerich
452e27c7292SMichael Hennerich return sprintf(buf, "%u\n", ac->disabled);
453e27c7292SMichael Hennerich }
454e27c7292SMichael Hennerich
adxl34x_disable_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)455e27c7292SMichael Hennerich static ssize_t adxl34x_disable_store(struct device *dev,
456e27c7292SMichael Hennerich struct device_attribute *attr,
457e27c7292SMichael Hennerich const char *buf, size_t count)
458e27c7292SMichael Hennerich {
459e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev);
46076496e7aSJJ Ding unsigned int val;
461e27c7292SMichael Hennerich int error;
462e27c7292SMichael Hennerich
46376496e7aSJJ Ding error = kstrtouint(buf, 10, &val);
464e27c7292SMichael Hennerich if (error)
465e27c7292SMichael Hennerich return error;
466e27c7292SMichael Hennerich
467af6e1d99SDmitry Torokhov mutex_lock(&ac->mutex);
468af6e1d99SDmitry Torokhov
469af6e1d99SDmitry Torokhov if (!ac->suspended && ac->opened) {
470af6e1d99SDmitry Torokhov if (val) {
471af6e1d99SDmitry Torokhov if (!ac->disabled)
472af6e1d99SDmitry Torokhov __adxl34x_disable(ac);
473af6e1d99SDmitry Torokhov } else {
474af6e1d99SDmitry Torokhov if (ac->disabled)
475af6e1d99SDmitry Torokhov __adxl34x_enable(ac);
476af6e1d99SDmitry Torokhov }
477af6e1d99SDmitry Torokhov }
478af6e1d99SDmitry Torokhov
479af6e1d99SDmitry Torokhov ac->disabled = !!val;
480af6e1d99SDmitry Torokhov
481af6e1d99SDmitry Torokhov mutex_unlock(&ac->mutex);
482e27c7292SMichael Hennerich
483e27c7292SMichael Hennerich return count;
484e27c7292SMichael Hennerich }
485e27c7292SMichael Hennerich
486e27c7292SMichael Hennerich static DEVICE_ATTR(disable, 0664, adxl34x_disable_show, adxl34x_disable_store);
487e27c7292SMichael Hennerich
adxl34x_calibrate_show(struct device * dev,struct device_attribute * attr,char * buf)488e27c7292SMichael Hennerich static ssize_t adxl34x_calibrate_show(struct device *dev,
489e27c7292SMichael Hennerich struct device_attribute *attr, char *buf)
490e27c7292SMichael Hennerich {
491e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev);
492e27c7292SMichael Hennerich ssize_t count;
493e27c7292SMichael Hennerich
494e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
495e27c7292SMichael Hennerich count = sprintf(buf, "%d,%d,%d\n",
496e27c7292SMichael Hennerich ac->hwcal.x * 4 + ac->swcal.x,
497e27c7292SMichael Hennerich ac->hwcal.y * 4 + ac->swcal.y,
498e27c7292SMichael Hennerich ac->hwcal.z * 4 + ac->swcal.z);
499e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
500e27c7292SMichael Hennerich
501e27c7292SMichael Hennerich return count;
502e27c7292SMichael Hennerich }
503e27c7292SMichael Hennerich
adxl34x_calibrate_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)504e27c7292SMichael Hennerich static ssize_t adxl34x_calibrate_store(struct device *dev,
505e27c7292SMichael Hennerich struct device_attribute *attr,
506e27c7292SMichael Hennerich const char *buf, size_t count)
507e27c7292SMichael Hennerich {
508e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev);
509e27c7292SMichael Hennerich
510e27c7292SMichael Hennerich /*
511e27c7292SMichael Hennerich * Hardware offset calibration has a resolution of 15.6 mg/LSB.
512e27c7292SMichael Hennerich * We use HW calibration and handle the remaining bits in SW. (4mg/LSB)
513e27c7292SMichael Hennerich */
514e27c7292SMichael Hennerich
515e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
516e27c7292SMichael Hennerich ac->hwcal.x -= (ac->saved.x / 4);
517e27c7292SMichael Hennerich ac->swcal.x = ac->saved.x % 4;
518e27c7292SMichael Hennerich
519e27c7292SMichael Hennerich ac->hwcal.y -= (ac->saved.y / 4);
520e27c7292SMichael Hennerich ac->swcal.y = ac->saved.y % 4;
521e27c7292SMichael Hennerich
522e27c7292SMichael Hennerich ac->hwcal.z -= (ac->saved.z / 4);
523e27c7292SMichael Hennerich ac->swcal.z = ac->saved.z % 4;
524e27c7292SMichael Hennerich
525e27c7292SMichael Hennerich AC_WRITE(ac, OFSX, (s8) ac->hwcal.x);
526e27c7292SMichael Hennerich AC_WRITE(ac, OFSY, (s8) ac->hwcal.y);
527e27c7292SMichael Hennerich AC_WRITE(ac, OFSZ, (s8) ac->hwcal.z);
528e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
529e27c7292SMichael Hennerich
530e27c7292SMichael Hennerich return count;
531e27c7292SMichael Hennerich }
532e27c7292SMichael Hennerich
533e27c7292SMichael Hennerich static DEVICE_ATTR(calibrate, 0664,
534e27c7292SMichael Hennerich adxl34x_calibrate_show, adxl34x_calibrate_store);
535e27c7292SMichael Hennerich
adxl34x_rate_show(struct device * dev,struct device_attribute * attr,char * buf)536e27c7292SMichael Hennerich static ssize_t adxl34x_rate_show(struct device *dev,
537e27c7292SMichael Hennerich struct device_attribute *attr, char *buf)
538e27c7292SMichael Hennerich {
539e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev);
540e27c7292SMichael Hennerich
541e27c7292SMichael Hennerich return sprintf(buf, "%u\n", RATE(ac->pdata.data_rate));
542e27c7292SMichael Hennerich }
543e27c7292SMichael Hennerich
adxl34x_rate_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)544e27c7292SMichael Hennerich static ssize_t adxl34x_rate_store(struct device *dev,
545e27c7292SMichael Hennerich struct device_attribute *attr,
546e27c7292SMichael Hennerich const char *buf, size_t count)
547e27c7292SMichael Hennerich {
548e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev);
54976496e7aSJJ Ding unsigned char val;
550e27c7292SMichael Hennerich int error;
551e27c7292SMichael Hennerich
55276496e7aSJJ Ding error = kstrtou8(buf, 10, &val);
553e27c7292SMichael Hennerich if (error)
554e27c7292SMichael Hennerich return error;
555e27c7292SMichael Hennerich
556e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
557e27c7292SMichael Hennerich
558e27c7292SMichael Hennerich ac->pdata.data_rate = RATE(val);
559e27c7292SMichael Hennerich AC_WRITE(ac, BW_RATE,
560e27c7292SMichael Hennerich ac->pdata.data_rate |
561e27c7292SMichael Hennerich (ac->pdata.low_power_mode ? LOW_POWER : 0));
562e27c7292SMichael Hennerich
563e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
564e27c7292SMichael Hennerich
565e27c7292SMichael Hennerich return count;
566e27c7292SMichael Hennerich }
567e27c7292SMichael Hennerich
568e27c7292SMichael Hennerich static DEVICE_ATTR(rate, 0664, adxl34x_rate_show, adxl34x_rate_store);
569e27c7292SMichael Hennerich
adxl34x_autosleep_show(struct device * dev,struct device_attribute * attr,char * buf)570e27c7292SMichael Hennerich static ssize_t adxl34x_autosleep_show(struct device *dev,
571e27c7292SMichael Hennerich struct device_attribute *attr, char *buf)
572e27c7292SMichael Hennerich {
573e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev);
574e27c7292SMichael Hennerich
575e27c7292SMichael Hennerich return sprintf(buf, "%u\n",
576e27c7292SMichael Hennerich ac->pdata.power_mode & (PCTL_AUTO_SLEEP | PCTL_LINK) ? 1 : 0);
577e27c7292SMichael Hennerich }
578e27c7292SMichael Hennerich
adxl34x_autosleep_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)579e27c7292SMichael Hennerich static ssize_t adxl34x_autosleep_store(struct device *dev,
580e27c7292SMichael Hennerich struct device_attribute *attr,
581e27c7292SMichael Hennerich const char *buf, size_t count)
582e27c7292SMichael Hennerich {
583e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev);
58476496e7aSJJ Ding unsigned int val;
585e27c7292SMichael Hennerich int error;
586e27c7292SMichael Hennerich
58776496e7aSJJ Ding error = kstrtouint(buf, 10, &val);
588e27c7292SMichael Hennerich if (error)
589e27c7292SMichael Hennerich return error;
590e27c7292SMichael Hennerich
591e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
592e27c7292SMichael Hennerich
593e27c7292SMichael Hennerich if (val)
594e27c7292SMichael Hennerich ac->pdata.power_mode |= (PCTL_AUTO_SLEEP | PCTL_LINK);
595e27c7292SMichael Hennerich else
596e27c7292SMichael Hennerich ac->pdata.power_mode &= ~(PCTL_AUTO_SLEEP | PCTL_LINK);
597e27c7292SMichael Hennerich
598af6e1d99SDmitry Torokhov if (!ac->disabled && !ac->suspended && ac->opened)
599e27c7292SMichael Hennerich AC_WRITE(ac, POWER_CTL, ac->pdata.power_mode | PCTL_MEASURE);
600e27c7292SMichael Hennerich
601e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
602e27c7292SMichael Hennerich
603e27c7292SMichael Hennerich return count;
604e27c7292SMichael Hennerich }
605e27c7292SMichael Hennerich
606e27c7292SMichael Hennerich static DEVICE_ATTR(autosleep, 0664,
607e27c7292SMichael Hennerich adxl34x_autosleep_show, adxl34x_autosleep_store);
608e27c7292SMichael Hennerich
adxl34x_position_show(struct device * dev,struct device_attribute * attr,char * buf)609e27c7292SMichael Hennerich static ssize_t adxl34x_position_show(struct device *dev,
610e27c7292SMichael Hennerich struct device_attribute *attr, char *buf)
611e27c7292SMichael Hennerich {
612e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev);
613e27c7292SMichael Hennerich ssize_t count;
614e27c7292SMichael Hennerich
615e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
616e27c7292SMichael Hennerich count = sprintf(buf, "(%d, %d, %d)\n",
617e27c7292SMichael Hennerich ac->saved.x, ac->saved.y, ac->saved.z);
618e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
619e27c7292SMichael Hennerich
620e27c7292SMichael Hennerich return count;
621e27c7292SMichael Hennerich }
622e27c7292SMichael Hennerich
623e27c7292SMichael Hennerich static DEVICE_ATTR(position, S_IRUGO, adxl34x_position_show, NULL);
624e27c7292SMichael Hennerich
625e27c7292SMichael Hennerich #ifdef ADXL_DEBUG
adxl34x_write_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)626e27c7292SMichael Hennerich static ssize_t adxl34x_write_store(struct device *dev,
627e27c7292SMichael Hennerich struct device_attribute *attr,
628e27c7292SMichael Hennerich const char *buf, size_t count)
629e27c7292SMichael Hennerich {
630e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev);
63176496e7aSJJ Ding unsigned int val;
632e27c7292SMichael Hennerich int error;
633e27c7292SMichael Hennerich
634e27c7292SMichael Hennerich /*
635e27c7292SMichael Hennerich * This allows basic ADXL register write access for debug purposes.
636e27c7292SMichael Hennerich */
63776496e7aSJJ Ding error = kstrtouint(buf, 16, &val);
638e27c7292SMichael Hennerich if (error)
639e27c7292SMichael Hennerich return error;
640e27c7292SMichael Hennerich
641e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
642e27c7292SMichael Hennerich AC_WRITE(ac, val >> 8, val & 0xFF);
643e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
644e27c7292SMichael Hennerich
645e27c7292SMichael Hennerich return count;
646e27c7292SMichael Hennerich }
647e27c7292SMichael Hennerich
648e27c7292SMichael Hennerich static DEVICE_ATTR(write, 0664, NULL, adxl34x_write_store);
649e27c7292SMichael Hennerich #endif
650e27c7292SMichael Hennerich
651e27c7292SMichael Hennerich static struct attribute *adxl34x_attributes[] = {
652e27c7292SMichael Hennerich &dev_attr_disable.attr,
653e27c7292SMichael Hennerich &dev_attr_calibrate.attr,
654e27c7292SMichael Hennerich &dev_attr_rate.attr,
655e27c7292SMichael Hennerich &dev_attr_autosleep.attr,
656e27c7292SMichael Hennerich &dev_attr_position.attr,
657e27c7292SMichael Hennerich #ifdef ADXL_DEBUG
658e27c7292SMichael Hennerich &dev_attr_write.attr,
659e27c7292SMichael Hennerich #endif
660e27c7292SMichael Hennerich NULL
661e27c7292SMichael Hennerich };
662e27c7292SMichael Hennerich
663e27c7292SMichael Hennerich static const struct attribute_group adxl34x_attr_group = {
664e27c7292SMichael Hennerich .attrs = adxl34x_attributes,
665e27c7292SMichael Hennerich };
666e27c7292SMichael Hennerich
adxl34x_input_open(struct input_dev * input)667e27c7292SMichael Hennerich static int adxl34x_input_open(struct input_dev *input)
668e27c7292SMichael Hennerich {
669e27c7292SMichael Hennerich struct adxl34x *ac = input_get_drvdata(input);
670e27c7292SMichael Hennerich
671e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
672af6e1d99SDmitry Torokhov
673af6e1d99SDmitry Torokhov if (!ac->suspended && !ac->disabled)
674e27c7292SMichael Hennerich __adxl34x_enable(ac);
675af6e1d99SDmitry Torokhov
676af6e1d99SDmitry Torokhov ac->opened = true;
677af6e1d99SDmitry Torokhov
678e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
679e27c7292SMichael Hennerich
680e27c7292SMichael Hennerich return 0;
681e27c7292SMichael Hennerich }
682e27c7292SMichael Hennerich
adxl34x_input_close(struct input_dev * input)683e27c7292SMichael Hennerich static void adxl34x_input_close(struct input_dev *input)
684e27c7292SMichael Hennerich {
685e27c7292SMichael Hennerich struct adxl34x *ac = input_get_drvdata(input);
686e27c7292SMichael Hennerich
687e27c7292SMichael Hennerich mutex_lock(&ac->mutex);
688af6e1d99SDmitry Torokhov
689af6e1d99SDmitry Torokhov if (!ac->suspended && !ac->disabled)
690e27c7292SMichael Hennerich __adxl34x_disable(ac);
691af6e1d99SDmitry Torokhov
692e27c7292SMichael Hennerich ac->opened = false;
693af6e1d99SDmitry Torokhov
694e27c7292SMichael Hennerich mutex_unlock(&ac->mutex);
695e27c7292SMichael Hennerich }
696e27c7292SMichael Hennerich
adxl34x_probe(struct device * dev,int irq,bool fifo_delay_default,const struct adxl34x_bus_ops * bops)697e27c7292SMichael Hennerich struct adxl34x *adxl34x_probe(struct device *dev, int irq,
698e27c7292SMichael Hennerich bool fifo_delay_default,
699e27c7292SMichael Hennerich const struct adxl34x_bus_ops *bops)
700e27c7292SMichael Hennerich {
701e27c7292SMichael Hennerich struct adxl34x *ac;
702e27c7292SMichael Hennerich struct input_dev *input_dev;
703e27c7292SMichael Hennerich const struct adxl34x_platform_data *pdata;
704671386bbSMichael Hennerich int err, range, i;
70533b6c39eSDan Carpenter int revid;
706e27c7292SMichael Hennerich
707e27c7292SMichael Hennerich if (!irq) {
708e27c7292SMichael Hennerich dev_err(dev, "no IRQ?\n");
709e27c7292SMichael Hennerich err = -ENODEV;
710e27c7292SMichael Hennerich goto err_out;
711e27c7292SMichael Hennerich }
712e27c7292SMichael Hennerich
713e27c7292SMichael Hennerich ac = kzalloc(sizeof(*ac), GFP_KERNEL);
714e27c7292SMichael Hennerich input_dev = input_allocate_device();
715e27c7292SMichael Hennerich if (!ac || !input_dev) {
716e27c7292SMichael Hennerich err = -ENOMEM;
717f1cba532SDan Carpenter goto err_free_mem;
718e27c7292SMichael Hennerich }
719e27c7292SMichael Hennerich
720e27c7292SMichael Hennerich ac->fifo_delay = fifo_delay_default;
721e27c7292SMichael Hennerich
722c838cb3dSJingoo Han pdata = dev_get_platdata(dev);
723e27c7292SMichael Hennerich if (!pdata) {
724e27c7292SMichael Hennerich dev_dbg(dev,
72525985edcSLucas De Marchi "No platform data: Using default initialization\n");
726e27c7292SMichael Hennerich pdata = &adxl34x_default_init;
727e27c7292SMichael Hennerich }
728e27c7292SMichael Hennerich
729e27c7292SMichael Hennerich ac->pdata = *pdata;
730e27c7292SMichael Hennerich pdata = &ac->pdata;
731e27c7292SMichael Hennerich
732e27c7292SMichael Hennerich ac->input = input_dev;
733e27c7292SMichael Hennerich ac->dev = dev;
734e27c7292SMichael Hennerich ac->irq = irq;
735e27c7292SMichael Hennerich ac->bops = bops;
736e27c7292SMichael Hennerich
737e27c7292SMichael Hennerich mutex_init(&ac->mutex);
738e27c7292SMichael Hennerich
739e27c7292SMichael Hennerich input_dev->name = "ADXL34x accelerometer";
740ad4e58b0SWolfram Sang revid = AC_READ(ac, DEVID);
741e27c7292SMichael Hennerich
742e27c7292SMichael Hennerich switch (revid) {
743e27c7292SMichael Hennerich case ID_ADXL345:
744e27c7292SMichael Hennerich ac->model = 345;
745e27c7292SMichael Hennerich break;
746e27c7292SMichael Hennerich case ID_ADXL346:
747e27c7292SMichael Hennerich ac->model = 346;
748e27c7292SMichael Hennerich break;
749e27c7292SMichael Hennerich default:
750e27c7292SMichael Hennerich dev_err(dev, "Failed to probe %s\n", input_dev->name);
751e27c7292SMichael Hennerich err = -ENODEV;
752e27c7292SMichael Hennerich goto err_free_mem;
753e27c7292SMichael Hennerich }
754e27c7292SMichael Hennerich
755e27c7292SMichael Hennerich snprintf(ac->phys, sizeof(ac->phys), "%s/input0", dev_name(dev));
756e27c7292SMichael Hennerich
757e27c7292SMichael Hennerich input_dev->phys = ac->phys;
758e27c7292SMichael Hennerich input_dev->dev.parent = dev;
759e27c7292SMichael Hennerich input_dev->id.product = ac->model;
760e27c7292SMichael Hennerich input_dev->id.bustype = bops->bustype;
761e27c7292SMichael Hennerich input_dev->open = adxl34x_input_open;
762e27c7292SMichael Hennerich input_dev->close = adxl34x_input_close;
763e27c7292SMichael Hennerich
764e27c7292SMichael Hennerich input_set_drvdata(input_dev, ac);
765e27c7292SMichael Hennerich
766e27c7292SMichael Hennerich __set_bit(ac->pdata.ev_type, input_dev->evbit);
767e27c7292SMichael Hennerich
768e27c7292SMichael Hennerich if (ac->pdata.ev_type == EV_REL) {
769e27c7292SMichael Hennerich __set_bit(REL_X, input_dev->relbit);
770e27c7292SMichael Hennerich __set_bit(REL_Y, input_dev->relbit);
771e27c7292SMichael Hennerich __set_bit(REL_Z, input_dev->relbit);
772e27c7292SMichael Hennerich } else {
773e27c7292SMichael Hennerich /* EV_ABS */
774e27c7292SMichael Hennerich __set_bit(ABS_X, input_dev->absbit);
775e27c7292SMichael Hennerich __set_bit(ABS_Y, input_dev->absbit);
776e27c7292SMichael Hennerich __set_bit(ABS_Z, input_dev->absbit);
777e27c7292SMichael Hennerich
778e27c7292SMichael Hennerich if (pdata->data_range & FULL_RES)
779e27c7292SMichael Hennerich range = ADXL_FULLRES_MAX_VAL; /* Signed 13-bit */
780e27c7292SMichael Hennerich else
781e27c7292SMichael Hennerich range = ADXL_FIXEDRES_MAX_VAL; /* Signed 10-bit */
782e27c7292SMichael Hennerich
783e27c7292SMichael Hennerich input_set_abs_params(input_dev, ABS_X, -range, range, 3, 3);
784e27c7292SMichael Hennerich input_set_abs_params(input_dev, ABS_Y, -range, range, 3, 3);
785e27c7292SMichael Hennerich input_set_abs_params(input_dev, ABS_Z, -range, range, 3, 3);
786e27c7292SMichael Hennerich }
787e27c7292SMichael Hennerich
788e27c7292SMichael Hennerich __set_bit(EV_KEY, input_dev->evbit);
789e27c7292SMichael Hennerich __set_bit(pdata->ev_code_tap[ADXL_X_AXIS], input_dev->keybit);
790e27c7292SMichael Hennerich __set_bit(pdata->ev_code_tap[ADXL_Y_AXIS], input_dev->keybit);
791e27c7292SMichael Hennerich __set_bit(pdata->ev_code_tap[ADXL_Z_AXIS], input_dev->keybit);
792e27c7292SMichael Hennerich
793e27c7292SMichael Hennerich if (pdata->ev_code_ff) {
794e27c7292SMichael Hennerich ac->int_mask = FREE_FALL;
795e27c7292SMichael Hennerich __set_bit(pdata->ev_code_ff, input_dev->keybit);
796e27c7292SMichael Hennerich }
797e27c7292SMichael Hennerich
798e27c7292SMichael Hennerich if (pdata->ev_code_act_inactivity)
799e27c7292SMichael Hennerich __set_bit(pdata->ev_code_act_inactivity, input_dev->keybit);
800e27c7292SMichael Hennerich
801e27c7292SMichael Hennerich ac->int_mask |= ACTIVITY | INACTIVITY;
802e27c7292SMichael Hennerich
803e27c7292SMichael Hennerich if (pdata->watermark) {
804e27c7292SMichael Hennerich ac->int_mask |= WATERMARK;
8051dbc080cSArnd Bergmann if (FIFO_MODE(pdata->fifo_mode) == FIFO_BYPASS)
806e27c7292SMichael Hennerich ac->pdata.fifo_mode |= FIFO_STREAM;
807e27c7292SMichael Hennerich } else {
808e27c7292SMichael Hennerich ac->int_mask |= DATA_READY;
809e27c7292SMichael Hennerich }
810e27c7292SMichael Hennerich
811e27c7292SMichael Hennerich if (pdata->tap_axis_control & (TAP_X_EN | TAP_Y_EN | TAP_Z_EN))
812e27c7292SMichael Hennerich ac->int_mask |= SINGLE_TAP | DOUBLE_TAP;
813e27c7292SMichael Hennerich
814e27c7292SMichael Hennerich if (FIFO_MODE(pdata->fifo_mode) == FIFO_BYPASS)
815e27c7292SMichael Hennerich ac->fifo_delay = false;
816e27c7292SMichael Hennerich
817ad4e58b0SWolfram Sang AC_WRITE(ac, POWER_CTL, 0);
818e27c7292SMichael Hennerich
819e27c7292SMichael Hennerich err = request_threaded_irq(ac->irq, NULL, adxl34x_irq,
820*e96220bcSMarek Vasut IRQF_ONESHOT, dev_name(dev), ac);
821e27c7292SMichael Hennerich if (err) {
822e27c7292SMichael Hennerich dev_err(dev, "irq %d busy?\n", ac->irq);
823e27c7292SMichael Hennerich goto err_free_mem;
824e27c7292SMichael Hennerich }
825e27c7292SMichael Hennerich
826e27c7292SMichael Hennerich err = sysfs_create_group(&dev->kobj, &adxl34x_attr_group);
827e27c7292SMichael Hennerich if (err)
828e27c7292SMichael Hennerich goto err_free_irq;
829e27c7292SMichael Hennerich
830e27c7292SMichael Hennerich err = input_register_device(input_dev);
831e27c7292SMichael Hennerich if (err)
832e27c7292SMichael Hennerich goto err_remove_attr;
833e27c7292SMichael Hennerich
834e27c7292SMichael Hennerich AC_WRITE(ac, OFSX, pdata->x_axis_offset);
835e27c7292SMichael Hennerich ac->hwcal.x = pdata->x_axis_offset;
836e27c7292SMichael Hennerich AC_WRITE(ac, OFSY, pdata->y_axis_offset);
837e27c7292SMichael Hennerich ac->hwcal.y = pdata->y_axis_offset;
838e27c7292SMichael Hennerich AC_WRITE(ac, OFSZ, pdata->z_axis_offset);
839e27c7292SMichael Hennerich ac->hwcal.z = pdata->z_axis_offset;
840e27c7292SMichael Hennerich AC_WRITE(ac, THRESH_TAP, pdata->tap_threshold);
841e27c7292SMichael Hennerich AC_WRITE(ac, DUR, pdata->tap_duration);
842e27c7292SMichael Hennerich AC_WRITE(ac, LATENT, pdata->tap_latency);
843e27c7292SMichael Hennerich AC_WRITE(ac, WINDOW, pdata->tap_window);
844e27c7292SMichael Hennerich AC_WRITE(ac, THRESH_ACT, pdata->activity_threshold);
845e27c7292SMichael Hennerich AC_WRITE(ac, THRESH_INACT, pdata->inactivity_threshold);
846e27c7292SMichael Hennerich AC_WRITE(ac, TIME_INACT, pdata->inactivity_time);
847e27c7292SMichael Hennerich AC_WRITE(ac, THRESH_FF, pdata->free_fall_threshold);
848e27c7292SMichael Hennerich AC_WRITE(ac, TIME_FF, pdata->free_fall_time);
849e27c7292SMichael Hennerich AC_WRITE(ac, TAP_AXES, pdata->tap_axis_control);
850e27c7292SMichael Hennerich AC_WRITE(ac, ACT_INACT_CTL, pdata->act_axis_control);
851e27c7292SMichael Hennerich AC_WRITE(ac, BW_RATE, RATE(ac->pdata.data_rate) |
852e27c7292SMichael Hennerich (pdata->low_power_mode ? LOW_POWER : 0));
853e27c7292SMichael Hennerich AC_WRITE(ac, DATA_FORMAT, pdata->data_range);
854e27c7292SMichael Hennerich AC_WRITE(ac, FIFO_CTL, FIFO_MODE(pdata->fifo_mode) |
855e27c7292SMichael Hennerich SAMPLES(pdata->watermark));
856e27c7292SMichael Hennerich
857671386bbSMichael Hennerich if (pdata->use_int2) {
858e27c7292SMichael Hennerich /* Map all INTs to INT2 */
859e27c7292SMichael Hennerich AC_WRITE(ac, INT_MAP, ac->int_mask | OVERRUN);
860671386bbSMichael Hennerich } else {
861e27c7292SMichael Hennerich /* Map all INTs to INT1 */
862e27c7292SMichael Hennerich AC_WRITE(ac, INT_MAP, 0);
863671386bbSMichael Hennerich }
864671386bbSMichael Hennerich
865671386bbSMichael Hennerich if (ac->model == 346 && ac->pdata.orientation_enable) {
866671386bbSMichael Hennerich AC_WRITE(ac, ORIENT_CONF,
867671386bbSMichael Hennerich ORIENT_DEADZONE(ac->pdata.deadzone_angle) |
868671386bbSMichael Hennerich ORIENT_DIVISOR(ac->pdata.divisor_length));
869671386bbSMichael Hennerich
870671386bbSMichael Hennerich ac->orient2d_saved = 1234;
871671386bbSMichael Hennerich ac->orient3d_saved = 1234;
872671386bbSMichael Hennerich
873671386bbSMichael Hennerich if (pdata->orientation_enable & ADXL_EN_ORIENTATION_3D)
874671386bbSMichael Hennerich for (i = 0; i < ARRAY_SIZE(pdata->ev_codes_orient_3d); i++)
875671386bbSMichael Hennerich __set_bit(pdata->ev_codes_orient_3d[i],
876671386bbSMichael Hennerich input_dev->keybit);
877671386bbSMichael Hennerich
878671386bbSMichael Hennerich if (pdata->orientation_enable & ADXL_EN_ORIENTATION_2D)
879671386bbSMichael Hennerich for (i = 0; i < ARRAY_SIZE(pdata->ev_codes_orient_2d); i++)
880671386bbSMichael Hennerich __set_bit(pdata->ev_codes_orient_2d[i],
881671386bbSMichael Hennerich input_dev->keybit);
882671386bbSMichael Hennerich } else {
883671386bbSMichael Hennerich ac->pdata.orientation_enable = 0;
884671386bbSMichael Hennerich }
885e27c7292SMichael Hennerich
886e27c7292SMichael Hennerich AC_WRITE(ac, INT_ENABLE, ac->int_mask | OVERRUN);
887e27c7292SMichael Hennerich
888e27c7292SMichael Hennerich ac->pdata.power_mode &= (PCTL_AUTO_SLEEP | PCTL_LINK);
889e27c7292SMichael Hennerich
890e27c7292SMichael Hennerich return ac;
891e27c7292SMichael Hennerich
892e27c7292SMichael Hennerich err_remove_attr:
893e27c7292SMichael Hennerich sysfs_remove_group(&dev->kobj, &adxl34x_attr_group);
894e27c7292SMichael Hennerich err_free_irq:
895e27c7292SMichael Hennerich free_irq(ac->irq, ac);
896e27c7292SMichael Hennerich err_free_mem:
897e27c7292SMichael Hennerich input_free_device(input_dev);
898e27c7292SMichael Hennerich kfree(ac);
899e27c7292SMichael Hennerich err_out:
900e27c7292SMichael Hennerich return ERR_PTR(err);
901e27c7292SMichael Hennerich }
902e27c7292SMichael Hennerich EXPORT_SYMBOL_GPL(adxl34x_probe);
903e27c7292SMichael Hennerich
adxl34x_remove(struct adxl34x * ac)904af98ff04SUwe Kleine-König void adxl34x_remove(struct adxl34x *ac)
905e27c7292SMichael Hennerich {
906e27c7292SMichael Hennerich sysfs_remove_group(&ac->dev->kobj, &adxl34x_attr_group);
907e27c7292SMichael Hennerich free_irq(ac->irq, ac);
908e27c7292SMichael Hennerich input_unregister_device(ac->input);
909f1cba532SDan Carpenter dev_dbg(ac->dev, "unregistered accelerometer\n");
910e27c7292SMichael Hennerich kfree(ac);
911e27c7292SMichael Hennerich }
912e27c7292SMichael Hennerich EXPORT_SYMBOL_GPL(adxl34x_remove);
913e27c7292SMichael Hennerich
91440be0646SJonathan Cameron EXPORT_GPL_SIMPLE_DEV_PM_OPS(adxl34x_pm, adxl34x_suspend, adxl34x_resume);
91540be0646SJonathan Cameron
916e27c7292SMichael Hennerich MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
917e27c7292SMichael Hennerich MODULE_DESCRIPTION("ADXL345/346 Three-Axis Digital Accelerometer Driver");
918e27c7292SMichael Hennerich MODULE_LICENSE("GPL");
919