xref: /openbmc/linux/drivers/input/misc/adxl34x.c (revision e27c7292)
1e27c7292SMichael Hennerich /*
2e27c7292SMichael Hennerich  * ADXL345/346 Three-Axis Digital Accelerometers
3e27c7292SMichael Hennerich  *
4e27c7292SMichael Hennerich  * Enter bugs at http://blackfin.uclinux.org/
5e27c7292SMichael Hennerich  *
6e27c7292SMichael Hennerich  * Copyright (C) 2009 Michael Hennerich, Analog Devices Inc.
7e27c7292SMichael Hennerich  * Licensed under the GPL-2 or later.
8e27c7292SMichael Hennerich  */
9e27c7292SMichael Hennerich 
10e27c7292SMichael Hennerich #include <linux/device.h>
11e27c7292SMichael Hennerich #include <linux/init.h>
12e27c7292SMichael Hennerich #include <linux/delay.h>
13e27c7292SMichael Hennerich #include <linux/input.h>
14e27c7292SMichael Hennerich #include <linux/interrupt.h>
15e27c7292SMichael Hennerich #include <linux/irq.h>
16e27c7292SMichael Hennerich #include <linux/slab.h>
17e27c7292SMichael Hennerich #include <linux/workqueue.h>
18e27c7292SMichael Hennerich #include <linux/input/adxl34x.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)
160e27c7292SMichael Hennerich #define ADXL346_2D_ORIENT(x)		(((x) & 0x3) >> 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];
199e27c7292SMichael Hennerich 	bool disabled;	/* P: mutex */
200e27c7292SMichael Hennerich 	bool opened;	/* P: mutex */
201e27c7292SMichael Hennerich 	bool fifo_delay;
202e27c7292SMichael Hennerich 	int irq;
203e27c7292SMichael Hennerich 	unsigned model;
204e27c7292SMichael Hennerich 	unsigned int_mask;
205e27c7292SMichael Hennerich 
206e27c7292SMichael Hennerich 	const struct adxl34x_bus_ops *bops;
207e27c7292SMichael Hennerich };
208e27c7292SMichael Hennerich 
209e27c7292SMichael Hennerich static const struct adxl34x_platform_data adxl34x_default_init = {
210e27c7292SMichael Hennerich 	.tap_threshold = 35,
211e27c7292SMichael Hennerich 	.tap_duration = 3,
212e27c7292SMichael Hennerich 	.tap_latency = 20,
213e27c7292SMichael Hennerich 	.tap_window = 20,
214e27c7292SMichael Hennerich 	.tap_axis_control = ADXL_TAP_X_EN | ADXL_TAP_Y_EN | ADXL_TAP_Z_EN,
215e27c7292SMichael Hennerich 	.act_axis_control = 0xFF,
216e27c7292SMichael Hennerich 	.activity_threshold = 6,
217e27c7292SMichael Hennerich 	.inactivity_threshold = 4,
218e27c7292SMichael Hennerich 	.inactivity_time = 3,
219e27c7292SMichael Hennerich 	.free_fall_threshold = 8,
220e27c7292SMichael Hennerich 	.free_fall_time = 0x20,
221e27c7292SMichael Hennerich 	.data_rate = 8,
222e27c7292SMichael Hennerich 	.data_range = ADXL_FULL_RES,
223e27c7292SMichael Hennerich 
224e27c7292SMichael Hennerich 	.ev_type = EV_ABS,
225e27c7292SMichael Hennerich 	.ev_code_x = ABS_X,	/* EV_REL */
226e27c7292SMichael Hennerich 	.ev_code_y = ABS_Y,	/* EV_REL */
227e27c7292SMichael Hennerich 	.ev_code_z = ABS_Z,	/* EV_REL */
228e27c7292SMichael Hennerich 
229e27c7292SMichael Hennerich 	.ev_code_tap = {BTN_TOUCH, BTN_TOUCH, BTN_TOUCH}, /* EV_KEY {x,y,z} */
230e27c7292SMichael Hennerich 	.power_mode = ADXL_AUTO_SLEEP | ADXL_LINK,
231e27c7292SMichael Hennerich 	.fifo_mode = FIFO_STREAM,
232e27c7292SMichael Hennerich 	.watermark = 0,
233e27c7292SMichael Hennerich };
234e27c7292SMichael Hennerich 
235e27c7292SMichael Hennerich static void adxl34x_get_triple(struct adxl34x *ac, struct axis_triple *axis)
236e27c7292SMichael Hennerich {
237e27c7292SMichael Hennerich 	short buf[3];
238e27c7292SMichael Hennerich 
239e27c7292SMichael Hennerich 	ac->bops->read_block(ac->dev, DATAX0, DATAZ1 - DATAX0 + 1, buf);
240e27c7292SMichael Hennerich 
241e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
242e27c7292SMichael Hennerich 	ac->saved.x = (s16) le16_to_cpu(buf[0]);
243e27c7292SMichael Hennerich 	axis->x = ac->saved.x;
244e27c7292SMichael Hennerich 
245e27c7292SMichael Hennerich 	ac->saved.y = (s16) le16_to_cpu(buf[1]);
246e27c7292SMichael Hennerich 	axis->y = ac->saved.y;
247e27c7292SMichael Hennerich 
248e27c7292SMichael Hennerich 	ac->saved.z = (s16) le16_to_cpu(buf[2]);
249e27c7292SMichael Hennerich 	axis->z = ac->saved.z;
250e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
251e27c7292SMichael Hennerich }
252e27c7292SMichael Hennerich 
253e27c7292SMichael Hennerich static void adxl34x_service_ev_fifo(struct adxl34x *ac)
254e27c7292SMichael Hennerich {
255e27c7292SMichael Hennerich 	struct adxl34x_platform_data *pdata = &ac->pdata;
256e27c7292SMichael Hennerich 	struct axis_triple axis;
257e27c7292SMichael Hennerich 
258e27c7292SMichael Hennerich 	adxl34x_get_triple(ac, &axis);
259e27c7292SMichael Hennerich 
260e27c7292SMichael Hennerich 	input_event(ac->input, pdata->ev_type, pdata->ev_code_x,
261e27c7292SMichael Hennerich 		    axis.x - ac->swcal.x);
262e27c7292SMichael Hennerich 	input_event(ac->input, pdata->ev_type, pdata->ev_code_y,
263e27c7292SMichael Hennerich 		    axis.y - ac->swcal.y);
264e27c7292SMichael Hennerich 	input_event(ac->input, pdata->ev_type, pdata->ev_code_z,
265e27c7292SMichael Hennerich 		    axis.z - ac->swcal.z);
266e27c7292SMichael Hennerich }
267e27c7292SMichael Hennerich 
268e27c7292SMichael Hennerich static void adxl34x_report_key_single(struct input_dev *input, int key)
269e27c7292SMichael Hennerich {
270e27c7292SMichael Hennerich 	input_report_key(input, key, true);
271e27c7292SMichael Hennerich 	input_sync(input);
272e27c7292SMichael Hennerich 	input_report_key(input, key, false);
273e27c7292SMichael Hennerich }
274e27c7292SMichael Hennerich 
275e27c7292SMichael Hennerich static void adxl34x_send_key_events(struct adxl34x *ac,
276e27c7292SMichael Hennerich 		struct adxl34x_platform_data *pdata, int status, int press)
277e27c7292SMichael Hennerich {
278e27c7292SMichael Hennerich 	int i;
279e27c7292SMichael Hennerich 
280e27c7292SMichael Hennerich 	for (i = ADXL_X_AXIS; i <= ADXL_Z_AXIS; i++) {
281e27c7292SMichael Hennerich 		if (status & (1 << (ADXL_Z_AXIS - i)))
282e27c7292SMichael Hennerich 			input_report_key(ac->input,
283e27c7292SMichael Hennerich 					 pdata->ev_code_tap[i], press);
284e27c7292SMichael Hennerich 	}
285e27c7292SMichael Hennerich }
286e27c7292SMichael Hennerich 
287e27c7292SMichael Hennerich static void adxl34x_do_tap(struct adxl34x *ac,
288e27c7292SMichael Hennerich 		struct adxl34x_platform_data *pdata, int status)
289e27c7292SMichael Hennerich {
290e27c7292SMichael Hennerich 	adxl34x_send_key_events(ac, pdata, status, true);
291e27c7292SMichael Hennerich 	input_sync(ac->input);
292e27c7292SMichael Hennerich 	adxl34x_send_key_events(ac, pdata, status, false);
293e27c7292SMichael Hennerich }
294e27c7292SMichael Hennerich 
295e27c7292SMichael Hennerich static irqreturn_t adxl34x_irq(int irq, void *handle)
296e27c7292SMichael Hennerich {
297e27c7292SMichael Hennerich 	struct adxl34x *ac = handle;
298e27c7292SMichael Hennerich 	struct adxl34x_platform_data *pdata = &ac->pdata;
299e27c7292SMichael Hennerich 	int int_stat, tap_stat, samples;
300e27c7292SMichael Hennerich 
301e27c7292SMichael Hennerich 	/*
302e27c7292SMichael Hennerich 	 * ACT_TAP_STATUS should be read before clearing the interrupt
303e27c7292SMichael Hennerich 	 * Avoid reading ACT_TAP_STATUS in case TAP detection is disabled
304e27c7292SMichael Hennerich 	 */
305e27c7292SMichael Hennerich 
306e27c7292SMichael Hennerich 	if (pdata->tap_axis_control & (TAP_X_EN | TAP_Y_EN | TAP_Z_EN))
307e27c7292SMichael Hennerich 		tap_stat = AC_READ(ac, ACT_TAP_STATUS);
308e27c7292SMichael Hennerich 	else
309e27c7292SMichael Hennerich 		tap_stat = 0;
310e27c7292SMichael Hennerich 
311e27c7292SMichael Hennerich 	int_stat = AC_READ(ac, INT_SOURCE);
312e27c7292SMichael Hennerich 
313e27c7292SMichael Hennerich 	if (int_stat & FREE_FALL)
314e27c7292SMichael Hennerich 		adxl34x_report_key_single(ac->input, pdata->ev_code_ff);
315e27c7292SMichael Hennerich 
316e27c7292SMichael Hennerich 	if (int_stat & OVERRUN)
317e27c7292SMichael Hennerich 		dev_dbg(ac->dev, "OVERRUN\n");
318e27c7292SMichael Hennerich 
319e27c7292SMichael Hennerich 	if (int_stat & (SINGLE_TAP | DOUBLE_TAP)) {
320e27c7292SMichael Hennerich 		adxl34x_do_tap(ac, pdata, tap_stat);
321e27c7292SMichael Hennerich 
322e27c7292SMichael Hennerich 		if (int_stat & DOUBLE_TAP)
323e27c7292SMichael Hennerich 			adxl34x_do_tap(ac, pdata, tap_stat);
324e27c7292SMichael Hennerich 	}
325e27c7292SMichael Hennerich 
326e27c7292SMichael Hennerich 	if (pdata->ev_code_act_inactivity) {
327e27c7292SMichael Hennerich 		if (int_stat & ACTIVITY)
328e27c7292SMichael Hennerich 			input_report_key(ac->input,
329e27c7292SMichael Hennerich 					 pdata->ev_code_act_inactivity, 1);
330e27c7292SMichael Hennerich 		if (int_stat & INACTIVITY)
331e27c7292SMichael Hennerich 			input_report_key(ac->input,
332e27c7292SMichael Hennerich 					 pdata->ev_code_act_inactivity, 0);
333e27c7292SMichael Hennerich 	}
334e27c7292SMichael Hennerich 
335e27c7292SMichael Hennerich 	if (int_stat & (DATA_READY | WATERMARK)) {
336e27c7292SMichael Hennerich 
337e27c7292SMichael Hennerich 		if (pdata->fifo_mode)
338e27c7292SMichael Hennerich 			samples = ENTRIES(AC_READ(ac, FIFO_STATUS)) + 1;
339e27c7292SMichael Hennerich 		else
340e27c7292SMichael Hennerich 			samples = 1;
341e27c7292SMichael Hennerich 
342e27c7292SMichael Hennerich 		for (; samples > 0; samples--) {
343e27c7292SMichael Hennerich 			adxl34x_service_ev_fifo(ac);
344e27c7292SMichael Hennerich 			/*
345e27c7292SMichael Hennerich 			 * To ensure that the FIFO has
346e27c7292SMichael Hennerich 			 * completely popped, there must be at least 5 us between
347e27c7292SMichael Hennerich 			 * the end of reading the data registers, signified by the
348e27c7292SMichael Hennerich 			 * transition to register 0x38 from 0x37 or the CS pin
349e27c7292SMichael Hennerich 			 * going high, and the start of new reads of the FIFO or
350e27c7292SMichael Hennerich 			 * reading the FIFO_STATUS register. For SPI operation at
351e27c7292SMichael Hennerich 			 * 1.5 MHz or lower, the register addressing portion of the
352e27c7292SMichael Hennerich 			 * transmission is sufficient delay to ensure the FIFO has
353e27c7292SMichael Hennerich 			 * completely popped. It is necessary for SPI operation
354e27c7292SMichael Hennerich 			 * greater than 1.5 MHz to de-assert the CS pin to ensure a
355e27c7292SMichael Hennerich 			 * total of 5 us, which is at most 3.4 us at 5 MHz
356e27c7292SMichael Hennerich 			 * operation.
357e27c7292SMichael Hennerich 			 */
358e27c7292SMichael Hennerich 			if (ac->fifo_delay && (samples > 1))
359e27c7292SMichael Hennerich 				udelay(3);
360e27c7292SMichael Hennerich 		}
361e27c7292SMichael Hennerich 	}
362e27c7292SMichael Hennerich 
363e27c7292SMichael Hennerich 	input_sync(ac->input);
364e27c7292SMichael Hennerich 
365e27c7292SMichael Hennerich 	return IRQ_HANDLED;
366e27c7292SMichael Hennerich }
367e27c7292SMichael Hennerich 
368e27c7292SMichael Hennerich static void __adxl34x_disable(struct adxl34x *ac)
369e27c7292SMichael Hennerich {
370e27c7292SMichael Hennerich 	if (!ac->disabled && ac->opened) {
371e27c7292SMichael Hennerich 		/*
372e27c7292SMichael Hennerich 		 * A '0' places the ADXL34x into standby mode
373e27c7292SMichael Hennerich 		 * with minimum power consumption.
374e27c7292SMichael Hennerich 		 */
375e27c7292SMichael Hennerich 		AC_WRITE(ac, POWER_CTL, 0);
376e27c7292SMichael Hennerich 
377e27c7292SMichael Hennerich 		ac->disabled = true;
378e27c7292SMichael Hennerich 	}
379e27c7292SMichael Hennerich }
380e27c7292SMichael Hennerich 
381e27c7292SMichael Hennerich static void __adxl34x_enable(struct adxl34x *ac)
382e27c7292SMichael Hennerich {
383e27c7292SMichael Hennerich 	if (ac->disabled && ac->opened) {
384e27c7292SMichael Hennerich 		AC_WRITE(ac, POWER_CTL, ac->pdata.power_mode | PCTL_MEASURE);
385e27c7292SMichael Hennerich 		ac->disabled = false;
386e27c7292SMichael Hennerich 	}
387e27c7292SMichael Hennerich }
388e27c7292SMichael Hennerich 
389e27c7292SMichael Hennerich void adxl34x_disable(struct adxl34x *ac)
390e27c7292SMichael Hennerich {
391e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
392e27c7292SMichael Hennerich 	__adxl34x_disable(ac);
393e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
394e27c7292SMichael Hennerich }
395e27c7292SMichael Hennerich EXPORT_SYMBOL_GPL(adxl34x_disable);
396e27c7292SMichael Hennerich 
397e27c7292SMichael Hennerich void adxl34x_enable(struct adxl34x *ac)
398e27c7292SMichael Hennerich {
399e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
400e27c7292SMichael Hennerich 	__adxl34x_enable(ac);
401e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
402e27c7292SMichael Hennerich }
403e27c7292SMichael Hennerich 
404e27c7292SMichael Hennerich EXPORT_SYMBOL_GPL(adxl34x_enable);
405e27c7292SMichael Hennerich 
406e27c7292SMichael Hennerich static ssize_t adxl34x_disable_show(struct device *dev,
407e27c7292SMichael Hennerich 				    struct device_attribute *attr, char *buf)
408e27c7292SMichael Hennerich {
409e27c7292SMichael Hennerich 	struct adxl34x *ac = dev_get_drvdata(dev);
410e27c7292SMichael Hennerich 
411e27c7292SMichael Hennerich 	return sprintf(buf, "%u\n", ac->disabled);
412e27c7292SMichael Hennerich }
413e27c7292SMichael Hennerich 
414e27c7292SMichael Hennerich static ssize_t adxl34x_disable_store(struct device *dev,
415e27c7292SMichael Hennerich 				     struct device_attribute *attr,
416e27c7292SMichael Hennerich 				     const char *buf, size_t count)
417e27c7292SMichael Hennerich {
418e27c7292SMichael Hennerich 	struct adxl34x *ac = dev_get_drvdata(dev);
419e27c7292SMichael Hennerich 	unsigned long val;
420e27c7292SMichael Hennerich 	int error;
421e27c7292SMichael Hennerich 
422e27c7292SMichael Hennerich 	error = strict_strtoul(buf, 10, &val);
423e27c7292SMichael Hennerich 	if (error)
424e27c7292SMichael Hennerich 		return error;
425e27c7292SMichael Hennerich 
426e27c7292SMichael Hennerich 	if (val)
427e27c7292SMichael Hennerich 		adxl34x_disable(ac);
428e27c7292SMichael Hennerich 	else
429e27c7292SMichael Hennerich 		adxl34x_enable(ac);
430e27c7292SMichael Hennerich 
431e27c7292SMichael Hennerich 	return count;
432e27c7292SMichael Hennerich }
433e27c7292SMichael Hennerich 
434e27c7292SMichael Hennerich static DEVICE_ATTR(disable, 0664, adxl34x_disable_show, adxl34x_disable_store);
435e27c7292SMichael Hennerich 
436e27c7292SMichael Hennerich static ssize_t adxl34x_calibrate_show(struct device *dev,
437e27c7292SMichael Hennerich 				      struct device_attribute *attr, char *buf)
438e27c7292SMichael Hennerich {
439e27c7292SMichael Hennerich 	struct adxl34x *ac = dev_get_drvdata(dev);
440e27c7292SMichael Hennerich 	ssize_t count;
441e27c7292SMichael Hennerich 
442e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
443e27c7292SMichael Hennerich 	count = sprintf(buf, "%d,%d,%d\n",
444e27c7292SMichael Hennerich 			ac->hwcal.x * 4 + ac->swcal.x,
445e27c7292SMichael Hennerich 			ac->hwcal.y * 4 + ac->swcal.y,
446e27c7292SMichael Hennerich 			ac->hwcal.z * 4 + ac->swcal.z);
447e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
448e27c7292SMichael Hennerich 
449e27c7292SMichael Hennerich 	return count;
450e27c7292SMichael Hennerich }
451e27c7292SMichael Hennerich 
452e27c7292SMichael Hennerich static ssize_t adxl34x_calibrate_store(struct device *dev,
453e27c7292SMichael Hennerich 				       struct device_attribute *attr,
454e27c7292SMichael Hennerich 				       const char *buf, size_t count)
455e27c7292SMichael Hennerich {
456e27c7292SMichael Hennerich 	struct adxl34x *ac = dev_get_drvdata(dev);
457e27c7292SMichael Hennerich 
458e27c7292SMichael Hennerich 	/*
459e27c7292SMichael Hennerich 	 * Hardware offset calibration has a resolution of 15.6 mg/LSB.
460e27c7292SMichael Hennerich 	 * We use HW calibration and handle the remaining bits in SW. (4mg/LSB)
461e27c7292SMichael Hennerich 	 */
462e27c7292SMichael Hennerich 
463e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
464e27c7292SMichael Hennerich 	ac->hwcal.x -= (ac->saved.x / 4);
465e27c7292SMichael Hennerich 	ac->swcal.x = ac->saved.x % 4;
466e27c7292SMichael Hennerich 
467e27c7292SMichael Hennerich 	ac->hwcal.y -= (ac->saved.y / 4);
468e27c7292SMichael Hennerich 	ac->swcal.y = ac->saved.y % 4;
469e27c7292SMichael Hennerich 
470e27c7292SMichael Hennerich 	ac->hwcal.z -= (ac->saved.z / 4);
471e27c7292SMichael Hennerich 	ac->swcal.z = ac->saved.z % 4;
472e27c7292SMichael Hennerich 
473e27c7292SMichael Hennerich 	AC_WRITE(ac, OFSX, (s8) ac->hwcal.x);
474e27c7292SMichael Hennerich 	AC_WRITE(ac, OFSY, (s8) ac->hwcal.y);
475e27c7292SMichael Hennerich 	AC_WRITE(ac, OFSZ, (s8) ac->hwcal.z);
476e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
477e27c7292SMichael Hennerich 
478e27c7292SMichael Hennerich 	return count;
479e27c7292SMichael Hennerich }
480e27c7292SMichael Hennerich 
481e27c7292SMichael Hennerich static DEVICE_ATTR(calibrate, 0664,
482e27c7292SMichael Hennerich 		   adxl34x_calibrate_show, adxl34x_calibrate_store);
483e27c7292SMichael Hennerich 
484e27c7292SMichael Hennerich static ssize_t adxl34x_rate_show(struct device *dev,
485e27c7292SMichael Hennerich 				 struct device_attribute *attr, char *buf)
486e27c7292SMichael Hennerich {
487e27c7292SMichael Hennerich 	struct adxl34x *ac = dev_get_drvdata(dev);
488e27c7292SMichael Hennerich 
489e27c7292SMichael Hennerich 	return sprintf(buf, "%u\n", RATE(ac->pdata.data_rate));
490e27c7292SMichael Hennerich }
491e27c7292SMichael Hennerich 
492e27c7292SMichael Hennerich static ssize_t adxl34x_rate_store(struct device *dev,
493e27c7292SMichael Hennerich 				  struct device_attribute *attr,
494e27c7292SMichael Hennerich 				  const char *buf, size_t count)
495e27c7292SMichael Hennerich {
496e27c7292SMichael Hennerich 	struct adxl34x *ac = dev_get_drvdata(dev);
497e27c7292SMichael Hennerich 	unsigned long val;
498e27c7292SMichael Hennerich 	int error;
499e27c7292SMichael Hennerich 
500e27c7292SMichael Hennerich 	error = strict_strtoul(buf, 10, &val);
501e27c7292SMichael Hennerich 	if (error)
502e27c7292SMichael Hennerich 		return error;
503e27c7292SMichael Hennerich 
504e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
505e27c7292SMichael Hennerich 
506e27c7292SMichael Hennerich 	ac->pdata.data_rate = RATE(val);
507e27c7292SMichael Hennerich 	AC_WRITE(ac, BW_RATE,
508e27c7292SMichael Hennerich 		 ac->pdata.data_rate |
509e27c7292SMichael Hennerich 			(ac->pdata.low_power_mode ? LOW_POWER : 0));
510e27c7292SMichael Hennerich 
511e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
512e27c7292SMichael Hennerich 
513e27c7292SMichael Hennerich 	return count;
514e27c7292SMichael Hennerich }
515e27c7292SMichael Hennerich 
516e27c7292SMichael Hennerich static DEVICE_ATTR(rate, 0664, adxl34x_rate_show, adxl34x_rate_store);
517e27c7292SMichael Hennerich 
518e27c7292SMichael Hennerich static ssize_t adxl34x_autosleep_show(struct device *dev,
519e27c7292SMichael Hennerich 				 struct device_attribute *attr, char *buf)
520e27c7292SMichael Hennerich {
521e27c7292SMichael Hennerich 	struct adxl34x *ac = dev_get_drvdata(dev);
522e27c7292SMichael Hennerich 
523e27c7292SMichael Hennerich 	return sprintf(buf, "%u\n",
524e27c7292SMichael Hennerich 		ac->pdata.power_mode & (PCTL_AUTO_SLEEP | PCTL_LINK) ? 1 : 0);
525e27c7292SMichael Hennerich }
526e27c7292SMichael Hennerich 
527e27c7292SMichael Hennerich static ssize_t adxl34x_autosleep_store(struct device *dev,
528e27c7292SMichael Hennerich 				  struct device_attribute *attr,
529e27c7292SMichael Hennerich 				  const char *buf, size_t count)
530e27c7292SMichael Hennerich {
531e27c7292SMichael Hennerich 	struct adxl34x *ac = dev_get_drvdata(dev);
532e27c7292SMichael Hennerich 	unsigned long val;
533e27c7292SMichael Hennerich 	int error;
534e27c7292SMichael Hennerich 
535e27c7292SMichael Hennerich 	error = strict_strtoul(buf, 10, &val);
536e27c7292SMichael Hennerich 	if (error)
537e27c7292SMichael Hennerich 		return error;
538e27c7292SMichael Hennerich 
539e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
540e27c7292SMichael Hennerich 
541e27c7292SMichael Hennerich 	if (val)
542e27c7292SMichael Hennerich 		ac->pdata.power_mode |= (PCTL_AUTO_SLEEP | PCTL_LINK);
543e27c7292SMichael Hennerich 	else
544e27c7292SMichael Hennerich 		ac->pdata.power_mode &= ~(PCTL_AUTO_SLEEP | PCTL_LINK);
545e27c7292SMichael Hennerich 
546e27c7292SMichael Hennerich 	if (!ac->disabled && ac->opened)
547e27c7292SMichael Hennerich 		AC_WRITE(ac, POWER_CTL, ac->pdata.power_mode | PCTL_MEASURE);
548e27c7292SMichael Hennerich 
549e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
550e27c7292SMichael Hennerich 
551e27c7292SMichael Hennerich 	return count;
552e27c7292SMichael Hennerich }
553e27c7292SMichael Hennerich 
554e27c7292SMichael Hennerich static DEVICE_ATTR(autosleep, 0664,
555e27c7292SMichael Hennerich 		   adxl34x_autosleep_show, adxl34x_autosleep_store);
556e27c7292SMichael Hennerich 
557e27c7292SMichael Hennerich static ssize_t adxl34x_position_show(struct device *dev,
558e27c7292SMichael Hennerich 				 struct device_attribute *attr, char *buf)
559e27c7292SMichael Hennerich {
560e27c7292SMichael Hennerich 	struct adxl34x *ac = dev_get_drvdata(dev);
561e27c7292SMichael Hennerich 	ssize_t count;
562e27c7292SMichael Hennerich 
563e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
564e27c7292SMichael Hennerich 	count = sprintf(buf, "(%d, %d, %d)\n",
565e27c7292SMichael Hennerich 			ac->saved.x, ac->saved.y, ac->saved.z);
566e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
567e27c7292SMichael Hennerich 
568e27c7292SMichael Hennerich 	return count;
569e27c7292SMichael Hennerich }
570e27c7292SMichael Hennerich 
571e27c7292SMichael Hennerich static DEVICE_ATTR(position, S_IRUGO, adxl34x_position_show, NULL);
572e27c7292SMichael Hennerich 
573e27c7292SMichael Hennerich #ifdef ADXL_DEBUG
574e27c7292SMichael Hennerich static ssize_t adxl34x_write_store(struct device *dev,
575e27c7292SMichael Hennerich 				   struct device_attribute *attr,
576e27c7292SMichael Hennerich 				   const char *buf, size_t count)
577e27c7292SMichael Hennerich {
578e27c7292SMichael Hennerich 	struct adxl34x *ac = dev_get_drvdata(dev);
579e27c7292SMichael Hennerich 	unsigned long val;
580e27c7292SMichael Hennerich 	int error;
581e27c7292SMichael Hennerich 
582e27c7292SMichael Hennerich 	/*
583e27c7292SMichael Hennerich 	 * This allows basic ADXL register write access for debug purposes.
584e27c7292SMichael Hennerich 	 */
585e27c7292SMichael Hennerich 	error = strict_strtoul(buf, 16, &val);
586e27c7292SMichael Hennerich 	if (error)
587e27c7292SMichael Hennerich 		return error;
588e27c7292SMichael Hennerich 
589e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
590e27c7292SMichael Hennerich 	AC_WRITE(ac, val >> 8, val & 0xFF);
591e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
592e27c7292SMichael Hennerich 
593e27c7292SMichael Hennerich 	return count;
594e27c7292SMichael Hennerich }
595e27c7292SMichael Hennerich 
596e27c7292SMichael Hennerich static DEVICE_ATTR(write, 0664, NULL, adxl34x_write_store);
597e27c7292SMichael Hennerich #endif
598e27c7292SMichael Hennerich 
599e27c7292SMichael Hennerich static struct attribute *adxl34x_attributes[] = {
600e27c7292SMichael Hennerich 	&dev_attr_disable.attr,
601e27c7292SMichael Hennerich 	&dev_attr_calibrate.attr,
602e27c7292SMichael Hennerich 	&dev_attr_rate.attr,
603e27c7292SMichael Hennerich 	&dev_attr_autosleep.attr,
604e27c7292SMichael Hennerich 	&dev_attr_position.attr,
605e27c7292SMichael Hennerich #ifdef ADXL_DEBUG
606e27c7292SMichael Hennerich 	&dev_attr_write.attr,
607e27c7292SMichael Hennerich #endif
608e27c7292SMichael Hennerich 	NULL
609e27c7292SMichael Hennerich };
610e27c7292SMichael Hennerich 
611e27c7292SMichael Hennerich static const struct attribute_group adxl34x_attr_group = {
612e27c7292SMichael Hennerich 	.attrs = adxl34x_attributes,
613e27c7292SMichael Hennerich };
614e27c7292SMichael Hennerich 
615e27c7292SMichael Hennerich static int adxl34x_input_open(struct input_dev *input)
616e27c7292SMichael Hennerich {
617e27c7292SMichael Hennerich 	struct adxl34x *ac = input_get_drvdata(input);
618e27c7292SMichael Hennerich 
619e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
620e27c7292SMichael Hennerich 	ac->opened = true;
621e27c7292SMichael Hennerich 	__adxl34x_enable(ac);
622e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
623e27c7292SMichael Hennerich 
624e27c7292SMichael Hennerich 	return 0;
625e27c7292SMichael Hennerich }
626e27c7292SMichael Hennerich 
627e27c7292SMichael Hennerich static void adxl34x_input_close(struct input_dev *input)
628e27c7292SMichael Hennerich {
629e27c7292SMichael Hennerich 	struct adxl34x *ac = input_get_drvdata(input);
630e27c7292SMichael Hennerich 
631e27c7292SMichael Hennerich 	mutex_lock(&ac->mutex);
632e27c7292SMichael Hennerich 	__adxl34x_disable(ac);
633e27c7292SMichael Hennerich 	ac->opened = false;
634e27c7292SMichael Hennerich 	mutex_unlock(&ac->mutex);
635e27c7292SMichael Hennerich }
636e27c7292SMichael Hennerich 
637e27c7292SMichael Hennerich struct adxl34x *adxl34x_probe(struct device *dev, int irq,
638e27c7292SMichael Hennerich 			      bool fifo_delay_default,
639e27c7292SMichael Hennerich 			      const struct adxl34x_bus_ops *bops)
640e27c7292SMichael Hennerich {
641e27c7292SMichael Hennerich 	struct adxl34x *ac;
642e27c7292SMichael Hennerich 	struct input_dev *input_dev;
643e27c7292SMichael Hennerich 	const struct adxl34x_platform_data *pdata;
644e27c7292SMichael Hennerich 	int err, range;
645e27c7292SMichael Hennerich 	unsigned char revid;
646e27c7292SMichael Hennerich 
647e27c7292SMichael Hennerich 	if (!irq) {
648e27c7292SMichael Hennerich 		dev_err(dev, "no IRQ?\n");
649e27c7292SMichael Hennerich 		err = -ENODEV;
650e27c7292SMichael Hennerich 		goto err_out;
651e27c7292SMichael Hennerich 	}
652e27c7292SMichael Hennerich 
653e27c7292SMichael Hennerich 	ac = kzalloc(sizeof(*ac), GFP_KERNEL);
654e27c7292SMichael Hennerich 	input_dev = input_allocate_device();
655e27c7292SMichael Hennerich 	if (!ac || !input_dev) {
656e27c7292SMichael Hennerich 		err = -ENOMEM;
657e27c7292SMichael Hennerich 		goto err_out;
658e27c7292SMichael Hennerich 	}
659e27c7292SMichael Hennerich 
660e27c7292SMichael Hennerich 	ac->fifo_delay = fifo_delay_default;
661e27c7292SMichael Hennerich 
662e27c7292SMichael Hennerich 	pdata = dev->platform_data;
663e27c7292SMichael Hennerich 	if (!pdata) {
664e27c7292SMichael Hennerich 		dev_dbg(dev,
665e27c7292SMichael Hennerich 			"No platfrom data: Using default initialization\n");
666e27c7292SMichael Hennerich 		pdata = &adxl34x_default_init;
667e27c7292SMichael Hennerich 	}
668e27c7292SMichael Hennerich 
669e27c7292SMichael Hennerich 	ac->pdata = *pdata;
670e27c7292SMichael Hennerich 	pdata = &ac->pdata;
671e27c7292SMichael Hennerich 
672e27c7292SMichael Hennerich 	ac->input = input_dev;
673e27c7292SMichael Hennerich 	ac->disabled = true;
674e27c7292SMichael Hennerich 	ac->dev = dev;
675e27c7292SMichael Hennerich 	ac->irq = irq;
676e27c7292SMichael Hennerich 	ac->bops = bops;
677e27c7292SMichael Hennerich 
678e27c7292SMichael Hennerich 	mutex_init(&ac->mutex);
679e27c7292SMichael Hennerich 
680e27c7292SMichael Hennerich 	input_dev->name = "ADXL34x accelerometer";
681e27c7292SMichael Hennerich 	revid = ac->bops->read(dev, DEVID);
682e27c7292SMichael Hennerich 
683e27c7292SMichael Hennerich 	switch (revid) {
684e27c7292SMichael Hennerich 	case ID_ADXL345:
685e27c7292SMichael Hennerich 		ac->model = 345;
686e27c7292SMichael Hennerich 		break;
687e27c7292SMichael Hennerich 	case ID_ADXL346:
688e27c7292SMichael Hennerich 		ac->model = 346;
689e27c7292SMichael Hennerich 		break;
690e27c7292SMichael Hennerich 	default:
691e27c7292SMichael Hennerich 		dev_err(dev, "Failed to probe %s\n", input_dev->name);
692e27c7292SMichael Hennerich 		err = -ENODEV;
693e27c7292SMichael Hennerich 		goto err_free_mem;
694e27c7292SMichael Hennerich 	}
695e27c7292SMichael Hennerich 
696e27c7292SMichael Hennerich 	snprintf(ac->phys, sizeof(ac->phys), "%s/input0", dev_name(dev));
697e27c7292SMichael Hennerich 
698e27c7292SMichael Hennerich 	input_dev->phys = ac->phys;
699e27c7292SMichael Hennerich 	input_dev->dev.parent = dev;
700e27c7292SMichael Hennerich 	input_dev->id.product = ac->model;
701e27c7292SMichael Hennerich 	input_dev->id.bustype = bops->bustype;
702e27c7292SMichael Hennerich 	input_dev->open = adxl34x_input_open;
703e27c7292SMichael Hennerich 	input_dev->close = adxl34x_input_close;
704e27c7292SMichael Hennerich 
705e27c7292SMichael Hennerich 	input_set_drvdata(input_dev, ac);
706e27c7292SMichael Hennerich 
707e27c7292SMichael Hennerich 	__set_bit(ac->pdata.ev_type, input_dev->evbit);
708e27c7292SMichael Hennerich 
709e27c7292SMichael Hennerich 	if (ac->pdata.ev_type == EV_REL) {
710e27c7292SMichael Hennerich 		__set_bit(REL_X, input_dev->relbit);
711e27c7292SMichael Hennerich 		__set_bit(REL_Y, input_dev->relbit);
712e27c7292SMichael Hennerich 		__set_bit(REL_Z, input_dev->relbit);
713e27c7292SMichael Hennerich 	} else {
714e27c7292SMichael Hennerich 		/* EV_ABS */
715e27c7292SMichael Hennerich 		__set_bit(ABS_X, input_dev->absbit);
716e27c7292SMichael Hennerich 		__set_bit(ABS_Y, input_dev->absbit);
717e27c7292SMichael Hennerich 		__set_bit(ABS_Z, input_dev->absbit);
718e27c7292SMichael Hennerich 
719e27c7292SMichael Hennerich 		if (pdata->data_range & FULL_RES)
720e27c7292SMichael Hennerich 			range = ADXL_FULLRES_MAX_VAL;	/* Signed 13-bit */
721e27c7292SMichael Hennerich 		else
722e27c7292SMichael Hennerich 			range = ADXL_FIXEDRES_MAX_VAL;	/* Signed 10-bit */
723e27c7292SMichael Hennerich 
724e27c7292SMichael Hennerich 		input_set_abs_params(input_dev, ABS_X, -range, range, 3, 3);
725e27c7292SMichael Hennerich 		input_set_abs_params(input_dev, ABS_Y, -range, range, 3, 3);
726e27c7292SMichael Hennerich 		input_set_abs_params(input_dev, ABS_Z, -range, range, 3, 3);
727e27c7292SMichael Hennerich 	}
728e27c7292SMichael Hennerich 
729e27c7292SMichael Hennerich 	__set_bit(EV_KEY, input_dev->evbit);
730e27c7292SMichael Hennerich 	__set_bit(pdata->ev_code_tap[ADXL_X_AXIS], input_dev->keybit);
731e27c7292SMichael Hennerich 	__set_bit(pdata->ev_code_tap[ADXL_Y_AXIS], input_dev->keybit);
732e27c7292SMichael Hennerich 	__set_bit(pdata->ev_code_tap[ADXL_Z_AXIS], input_dev->keybit);
733e27c7292SMichael Hennerich 
734e27c7292SMichael Hennerich 	if (pdata->ev_code_ff) {
735e27c7292SMichael Hennerich 		ac->int_mask = FREE_FALL;
736e27c7292SMichael Hennerich 		__set_bit(pdata->ev_code_ff, input_dev->keybit);
737e27c7292SMichael Hennerich 	}
738e27c7292SMichael Hennerich 
739e27c7292SMichael Hennerich 	if (pdata->ev_code_act_inactivity)
740e27c7292SMichael Hennerich 		__set_bit(pdata->ev_code_act_inactivity, input_dev->keybit);
741e27c7292SMichael Hennerich 
742e27c7292SMichael Hennerich 	ac->int_mask |= ACTIVITY | INACTIVITY;
743e27c7292SMichael Hennerich 
744e27c7292SMichael Hennerich 	if (pdata->watermark) {
745e27c7292SMichael Hennerich 		ac->int_mask |= WATERMARK;
746e27c7292SMichael Hennerich 		if (!FIFO_MODE(pdata->fifo_mode))
747e27c7292SMichael Hennerich 			ac->pdata.fifo_mode |= FIFO_STREAM;
748e27c7292SMichael Hennerich 	} else {
749e27c7292SMichael Hennerich 		ac->int_mask |= DATA_READY;
750e27c7292SMichael Hennerich 	}
751e27c7292SMichael Hennerich 
752e27c7292SMichael Hennerich 	if (pdata->tap_axis_control & (TAP_X_EN | TAP_Y_EN | TAP_Z_EN))
753e27c7292SMichael Hennerich 		ac->int_mask |= SINGLE_TAP | DOUBLE_TAP;
754e27c7292SMichael Hennerich 
755e27c7292SMichael Hennerich 	if (FIFO_MODE(pdata->fifo_mode) == FIFO_BYPASS)
756e27c7292SMichael Hennerich 		ac->fifo_delay = false;
757e27c7292SMichael Hennerich 
758e27c7292SMichael Hennerich 	ac->bops->write(dev, POWER_CTL, 0);
759e27c7292SMichael Hennerich 
760e27c7292SMichael Hennerich 	err = request_threaded_irq(ac->irq, NULL, adxl34x_irq,
761e27c7292SMichael Hennerich 				   IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
762e27c7292SMichael Hennerich 				   dev_name(dev), ac);
763e27c7292SMichael Hennerich 	if (err) {
764e27c7292SMichael Hennerich 		dev_err(dev, "irq %d busy?\n", ac->irq);
765e27c7292SMichael Hennerich 		goto err_free_mem;
766e27c7292SMichael Hennerich 	}
767e27c7292SMichael Hennerich 
768e27c7292SMichael Hennerich 	err = sysfs_create_group(&dev->kobj, &adxl34x_attr_group);
769e27c7292SMichael Hennerich 	if (err)
770e27c7292SMichael Hennerich 		goto err_free_irq;
771e27c7292SMichael Hennerich 
772e27c7292SMichael Hennerich 	err = input_register_device(input_dev);
773e27c7292SMichael Hennerich 	if (err)
774e27c7292SMichael Hennerich 		goto err_remove_attr;
775e27c7292SMichael Hennerich 
776e27c7292SMichael Hennerich 	AC_WRITE(ac, THRESH_TAP, pdata->tap_threshold);
777e27c7292SMichael Hennerich 	AC_WRITE(ac, OFSX, pdata->x_axis_offset);
778e27c7292SMichael Hennerich 	ac->hwcal.x = pdata->x_axis_offset;
779e27c7292SMichael Hennerich 	AC_WRITE(ac, OFSY, pdata->y_axis_offset);
780e27c7292SMichael Hennerich 	ac->hwcal.y = pdata->y_axis_offset;
781e27c7292SMichael Hennerich 	AC_WRITE(ac, OFSZ, pdata->z_axis_offset);
782e27c7292SMichael Hennerich 	ac->hwcal.z = pdata->z_axis_offset;
783e27c7292SMichael Hennerich 	AC_WRITE(ac, THRESH_TAP, pdata->tap_threshold);
784e27c7292SMichael Hennerich 	AC_WRITE(ac, DUR, pdata->tap_duration);
785e27c7292SMichael Hennerich 	AC_WRITE(ac, LATENT, pdata->tap_latency);
786e27c7292SMichael Hennerich 	AC_WRITE(ac, WINDOW, pdata->tap_window);
787e27c7292SMichael Hennerich 	AC_WRITE(ac, THRESH_ACT, pdata->activity_threshold);
788e27c7292SMichael Hennerich 	AC_WRITE(ac, THRESH_INACT, pdata->inactivity_threshold);
789e27c7292SMichael Hennerich 	AC_WRITE(ac, TIME_INACT, pdata->inactivity_time);
790e27c7292SMichael Hennerich 	AC_WRITE(ac, THRESH_FF, pdata->free_fall_threshold);
791e27c7292SMichael Hennerich 	AC_WRITE(ac, TIME_FF, pdata->free_fall_time);
792e27c7292SMichael Hennerich 	AC_WRITE(ac, TAP_AXES, pdata->tap_axis_control);
793e27c7292SMichael Hennerich 	AC_WRITE(ac, ACT_INACT_CTL, pdata->act_axis_control);
794e27c7292SMichael Hennerich 	AC_WRITE(ac, BW_RATE, RATE(ac->pdata.data_rate) |
795e27c7292SMichael Hennerich 		 (pdata->low_power_mode ? LOW_POWER : 0));
796e27c7292SMichael Hennerich 	AC_WRITE(ac, DATA_FORMAT, pdata->data_range);
797e27c7292SMichael Hennerich 	AC_WRITE(ac, FIFO_CTL, FIFO_MODE(pdata->fifo_mode) |
798e27c7292SMichael Hennerich 			SAMPLES(pdata->watermark));
799e27c7292SMichael Hennerich 
800e27c7292SMichael Hennerich 	if (pdata->use_int2)
801e27c7292SMichael Hennerich 		/* Map all INTs to INT2 */
802e27c7292SMichael Hennerich 		AC_WRITE(ac, INT_MAP, ac->int_mask | OVERRUN);
803e27c7292SMichael Hennerich 	else
804e27c7292SMichael Hennerich 		/* Map all INTs to INT1 */
805e27c7292SMichael Hennerich 		AC_WRITE(ac, INT_MAP, 0);
806e27c7292SMichael Hennerich 
807e27c7292SMichael Hennerich 	AC_WRITE(ac, INT_ENABLE, ac->int_mask | OVERRUN);
808e27c7292SMichael Hennerich 
809e27c7292SMichael Hennerich 	ac->pdata.power_mode &= (PCTL_AUTO_SLEEP | PCTL_LINK);
810e27c7292SMichael Hennerich 
811e27c7292SMichael Hennerich 	return ac;
812e27c7292SMichael Hennerich 
813e27c7292SMichael Hennerich  err_remove_attr:
814e27c7292SMichael Hennerich 	sysfs_remove_group(&dev->kobj, &adxl34x_attr_group);
815e27c7292SMichael Hennerich  err_free_irq:
816e27c7292SMichael Hennerich 	free_irq(ac->irq, ac);
817e27c7292SMichael Hennerich  err_free_mem:
818e27c7292SMichael Hennerich 	input_free_device(input_dev);
819e27c7292SMichael Hennerich 	kfree(ac);
820e27c7292SMichael Hennerich  err_out:
821e27c7292SMichael Hennerich 	return ERR_PTR(err);
822e27c7292SMichael Hennerich }
823e27c7292SMichael Hennerich EXPORT_SYMBOL_GPL(adxl34x_probe);
824e27c7292SMichael Hennerich 
825e27c7292SMichael Hennerich int adxl34x_remove(struct adxl34x *ac)
826e27c7292SMichael Hennerich {
827e27c7292SMichael Hennerich 	adxl34x_disable(ac);
828e27c7292SMichael Hennerich 	sysfs_remove_group(&ac->dev->kobj, &adxl34x_attr_group);
829e27c7292SMichael Hennerich 	free_irq(ac->irq, ac);
830e27c7292SMichael Hennerich 	input_unregister_device(ac->input);
831e27c7292SMichael Hennerich 	kfree(ac);
832e27c7292SMichael Hennerich 
833e27c7292SMichael Hennerich 	dev_dbg(ac->dev, "unregistered accelerometer\n");
834e27c7292SMichael Hennerich 	return 0;
835e27c7292SMichael Hennerich }
836e27c7292SMichael Hennerich EXPORT_SYMBOL_GPL(adxl34x_remove);
837e27c7292SMichael Hennerich 
838e27c7292SMichael Hennerich MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
839e27c7292SMichael Hennerich MODULE_DESCRIPTION("ADXL345/346 Three-Axis Digital Accelerometer Driver");
840e27c7292SMichael Hennerich MODULE_LICENSE("GPL");
841