1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * VTI CMA3000_D0x Accelerometer driver
4  *
5  * Copyright (C) 2010 Texas Instruments
6  * Author: Hemanth V <hemanthv@ti.com>
7  */
8 
9 #include <linux/types.h>
10 #include <linux/interrupt.h>
11 #include <linux/delay.h>
12 #include <linux/slab.h>
13 #include <linux/input.h>
14 #include <linux/input/cma3000.h>
15 #include <linux/module.h>
16 
17 #include "cma3000_d0x.h"
18 
19 #define CMA3000_WHOAMI      0x00
20 #define CMA3000_REVID       0x01
21 #define CMA3000_CTRL        0x02
22 #define CMA3000_STATUS      0x03
23 #define CMA3000_RSTR        0x04
24 #define CMA3000_INTSTATUS   0x05
25 #define CMA3000_DOUTX       0x06
26 #define CMA3000_DOUTY       0x07
27 #define CMA3000_DOUTZ       0x08
28 #define CMA3000_MDTHR       0x09
29 #define CMA3000_MDFFTMR     0x0A
30 #define CMA3000_FFTHR       0x0B
31 
32 #define CMA3000_RANGE2G    (1 << 7)
33 #define CMA3000_RANGE8G    (0 << 7)
34 #define CMA3000_BUSI2C     (0 << 4)
35 #define CMA3000_MODEMASK   (7 << 1)
36 #define CMA3000_GRANGEMASK (1 << 7)
37 
38 #define CMA3000_STATUS_PERR    1
39 #define CMA3000_INTSTATUS_FFDET (1 << 2)
40 
41 /* Settling time delay in ms */
42 #define CMA3000_SETDELAY    30
43 
44 /* Delay for clearing interrupt in us */
45 #define CMA3000_INTDELAY    44
46 
47 
48 /*
49  * Bit weights in mg for bit 0, other bits need
50  * multiply factor 2^n. Eight bit is the sign bit.
51  */
52 #define BIT_TO_2G  18
53 #define BIT_TO_8G  71
54 
55 struct cma3000_accl_data {
56 	const struct cma3000_bus_ops *bus_ops;
57 	const struct cma3000_platform_data *pdata;
58 
59 	struct device *dev;
60 	struct input_dev *input_dev;
61 
62 	int bit_to_mg;
63 	int irq;
64 
65 	int g_range;
66 	u8 mode;
67 
68 	struct mutex mutex;
69 	bool opened;
70 	bool suspended;
71 };
72 
73 #define CMA3000_READ(data, reg, msg) \
74 	(data->bus_ops->read(data->dev, reg, msg))
75 #define CMA3000_SET(data, reg, val, msg) \
76 	((data)->bus_ops->write(data->dev, reg, val, msg))
77 
78 /*
79  * Conversion for each of the eight modes to g, depending
80  * on G range i.e 2G or 8G. Some modes always operate in
81  * 8G.
82  */
83 
84 static int mode_to_mg[8][2] = {
85 	{ 0, 0 },
86 	{ BIT_TO_8G, BIT_TO_2G },
87 	{ BIT_TO_8G, BIT_TO_2G },
88 	{ BIT_TO_8G, BIT_TO_8G },
89 	{ BIT_TO_8G, BIT_TO_8G },
90 	{ BIT_TO_8G, BIT_TO_2G },
91 	{ BIT_TO_8G, BIT_TO_2G },
92 	{ 0, 0},
93 };
94 
decode_mg(struct cma3000_accl_data * data,int * datax,int * datay,int * dataz)95 static void decode_mg(struct cma3000_accl_data *data, int *datax,
96 				int *datay, int *dataz)
97 {
98 	/* Data in 2's complement, convert to mg */
99 	*datax = ((s8)*datax) * data->bit_to_mg;
100 	*datay = ((s8)*datay) * data->bit_to_mg;
101 	*dataz = ((s8)*dataz) * data->bit_to_mg;
102 }
103 
cma3000_thread_irq(int irq,void * dev_id)104 static irqreturn_t cma3000_thread_irq(int irq, void *dev_id)
105 {
106 	struct cma3000_accl_data *data = dev_id;
107 	int datax, datay, dataz, intr_status;
108 	u8 ctrl, mode, range;
109 
110 	intr_status = CMA3000_READ(data, CMA3000_INTSTATUS, "interrupt status");
111 	if (intr_status < 0)
112 		return IRQ_NONE;
113 
114 	/* Check if free fall is detected, report immediately */
115 	if (intr_status & CMA3000_INTSTATUS_FFDET) {
116 		input_report_abs(data->input_dev, ABS_MISC, 1);
117 		input_sync(data->input_dev);
118 	} else {
119 		input_report_abs(data->input_dev, ABS_MISC, 0);
120 	}
121 
122 	datax = CMA3000_READ(data, CMA3000_DOUTX, "X");
123 	datay = CMA3000_READ(data, CMA3000_DOUTY, "Y");
124 	dataz = CMA3000_READ(data, CMA3000_DOUTZ, "Z");
125 
126 	ctrl = CMA3000_READ(data, CMA3000_CTRL, "ctrl");
127 	mode = (ctrl & CMA3000_MODEMASK) >> 1;
128 	range = (ctrl & CMA3000_GRANGEMASK) >> 7;
129 
130 	data->bit_to_mg = mode_to_mg[mode][range];
131 
132 	/* Interrupt not for this device */
133 	if (data->bit_to_mg == 0)
134 		return IRQ_NONE;
135 
136 	/* Decode register values to milli g */
137 	decode_mg(data, &datax, &datay, &dataz);
138 
139 	input_report_abs(data->input_dev, ABS_X, datax);
140 	input_report_abs(data->input_dev, ABS_Y, datay);
141 	input_report_abs(data->input_dev, ABS_Z, dataz);
142 	input_sync(data->input_dev);
143 
144 	return IRQ_HANDLED;
145 }
146 
cma3000_reset(struct cma3000_accl_data * data)147 static int cma3000_reset(struct cma3000_accl_data *data)
148 {
149 	int val;
150 
151 	/* Reset sequence */
152 	CMA3000_SET(data, CMA3000_RSTR, 0x02, "Reset");
153 	CMA3000_SET(data, CMA3000_RSTR, 0x0A, "Reset");
154 	CMA3000_SET(data, CMA3000_RSTR, 0x04, "Reset");
155 
156 	/* Settling time delay */
157 	mdelay(10);
158 
159 	val = CMA3000_READ(data, CMA3000_STATUS, "Status");
160 	if (val < 0) {
161 		dev_err(data->dev, "Reset failed\n");
162 		return val;
163 	}
164 
165 	if (val & CMA3000_STATUS_PERR) {
166 		dev_err(data->dev, "Parity Error\n");
167 		return -EIO;
168 	}
169 
170 	return 0;
171 }
172 
cma3000_poweron(struct cma3000_accl_data * data)173 static int cma3000_poweron(struct cma3000_accl_data *data)
174 {
175 	const struct cma3000_platform_data *pdata = data->pdata;
176 	u8 ctrl = 0;
177 	int ret;
178 
179 	if (data->g_range == CMARANGE_2G) {
180 		ctrl = (data->mode << 1) | CMA3000_RANGE2G;
181 	} else if (data->g_range == CMARANGE_8G) {
182 		ctrl = (data->mode << 1) | CMA3000_RANGE8G;
183 	} else {
184 		dev_info(data->dev,
185 			 "Invalid G range specified, assuming 8G\n");
186 		ctrl = (data->mode << 1) | CMA3000_RANGE8G;
187 	}
188 
189 	ctrl |= data->bus_ops->ctrl_mod;
190 
191 	CMA3000_SET(data, CMA3000_MDTHR, pdata->mdthr,
192 		    "Motion Detect Threshold");
193 	CMA3000_SET(data, CMA3000_MDFFTMR, pdata->mdfftmr,
194 		    "Time register");
195 	CMA3000_SET(data, CMA3000_FFTHR, pdata->ffthr,
196 		    "Free fall threshold");
197 	ret = CMA3000_SET(data, CMA3000_CTRL, ctrl, "Mode setting");
198 	if (ret < 0)
199 		return -EIO;
200 
201 	msleep(CMA3000_SETDELAY);
202 
203 	return 0;
204 }
205 
cma3000_poweroff(struct cma3000_accl_data * data)206 static int cma3000_poweroff(struct cma3000_accl_data *data)
207 {
208 	int ret;
209 
210 	ret = CMA3000_SET(data, CMA3000_CTRL, CMAMODE_POFF, "Mode setting");
211 	msleep(CMA3000_SETDELAY);
212 
213 	return ret;
214 }
215 
cma3000_open(struct input_dev * input_dev)216 static int cma3000_open(struct input_dev *input_dev)
217 {
218 	struct cma3000_accl_data *data = input_get_drvdata(input_dev);
219 
220 	mutex_lock(&data->mutex);
221 
222 	if (!data->suspended)
223 		cma3000_poweron(data);
224 
225 	data->opened = true;
226 
227 	mutex_unlock(&data->mutex);
228 
229 	return 0;
230 }
231 
cma3000_close(struct input_dev * input_dev)232 static void cma3000_close(struct input_dev *input_dev)
233 {
234 	struct cma3000_accl_data *data = input_get_drvdata(input_dev);
235 
236 	mutex_lock(&data->mutex);
237 
238 	if (!data->suspended)
239 		cma3000_poweroff(data);
240 
241 	data->opened = false;
242 
243 	mutex_unlock(&data->mutex);
244 }
245 
cma3000_suspend(struct cma3000_accl_data * data)246 void cma3000_suspend(struct cma3000_accl_data *data)
247 {
248 	mutex_lock(&data->mutex);
249 
250 	if (!data->suspended && data->opened)
251 		cma3000_poweroff(data);
252 
253 	data->suspended = true;
254 
255 	mutex_unlock(&data->mutex);
256 }
257 EXPORT_SYMBOL(cma3000_suspend);
258 
259 
cma3000_resume(struct cma3000_accl_data * data)260 void cma3000_resume(struct cma3000_accl_data *data)
261 {
262 	mutex_lock(&data->mutex);
263 
264 	if (data->suspended && data->opened)
265 		cma3000_poweron(data);
266 
267 	data->suspended = false;
268 
269 	mutex_unlock(&data->mutex);
270 }
271 EXPORT_SYMBOL(cma3000_resume);
272 
cma3000_init(struct device * dev,int irq,const struct cma3000_bus_ops * bops)273 struct cma3000_accl_data *cma3000_init(struct device *dev, int irq,
274 				       const struct cma3000_bus_ops *bops)
275 {
276 	const struct cma3000_platform_data *pdata = dev_get_platdata(dev);
277 	struct cma3000_accl_data *data;
278 	struct input_dev *input_dev;
279 	int rev;
280 	int error;
281 
282 	if (!pdata) {
283 		dev_err(dev, "platform data not found\n");
284 		error = -EINVAL;
285 		goto err_out;
286 	}
287 
288 
289 	/* if no IRQ return error */
290 	if (irq == 0) {
291 		error = -EINVAL;
292 		goto err_out;
293 	}
294 
295 	data = kzalloc(sizeof(struct cma3000_accl_data), GFP_KERNEL);
296 	input_dev = input_allocate_device();
297 	if (!data || !input_dev) {
298 		error = -ENOMEM;
299 		goto err_free_mem;
300 	}
301 
302 	data->dev = dev;
303 	data->input_dev = input_dev;
304 	data->bus_ops = bops;
305 	data->pdata = pdata;
306 	data->irq = irq;
307 	mutex_init(&data->mutex);
308 
309 	data->mode = pdata->mode;
310 	if (data->mode > CMAMODE_POFF) {
311 		data->mode = CMAMODE_MOTDET;
312 		dev_warn(dev,
313 			 "Invalid mode specified, assuming Motion Detect\n");
314 	}
315 
316 	data->g_range = pdata->g_range;
317 	if (data->g_range != CMARANGE_2G && data->g_range != CMARANGE_8G) {
318 		dev_info(dev,
319 			 "Invalid G range specified, assuming 8G\n");
320 		data->g_range = CMARANGE_8G;
321 	}
322 
323 	input_dev->name = "cma3000-accelerometer";
324 	input_dev->id.bustype = bops->bustype;
325 	input_dev->open = cma3000_open;
326 	input_dev->close = cma3000_close;
327 
328 	input_set_abs_params(input_dev, ABS_X,
329 			-data->g_range, data->g_range, pdata->fuzz_x, 0);
330 	input_set_abs_params(input_dev, ABS_Y,
331 			-data->g_range, data->g_range, pdata->fuzz_y, 0);
332 	input_set_abs_params(input_dev, ABS_Z,
333 			-data->g_range, data->g_range, pdata->fuzz_z, 0);
334 	input_set_abs_params(input_dev, ABS_MISC, 0, 1, 0, 0);
335 
336 	input_set_drvdata(input_dev, data);
337 
338 	error = cma3000_reset(data);
339 	if (error)
340 		goto err_free_mem;
341 
342 	rev = CMA3000_READ(data, CMA3000_REVID, "Revid");
343 	if (rev < 0) {
344 		error = rev;
345 		goto err_free_mem;
346 	}
347 
348 	pr_info("CMA3000 Accelerometer: Revision %x\n", rev);
349 
350 	error = request_threaded_irq(irq, NULL, cma3000_thread_irq,
351 				     pdata->irqflags | IRQF_ONESHOT,
352 				     "cma3000_d0x", data);
353 	if (error) {
354 		dev_err(dev, "request_threaded_irq failed\n");
355 		goto err_free_mem;
356 	}
357 
358 	error = input_register_device(data->input_dev);
359 	if (error) {
360 		dev_err(dev, "Unable to register input device\n");
361 		goto err_free_irq;
362 	}
363 
364 	return data;
365 
366 err_free_irq:
367 	free_irq(irq, data);
368 err_free_mem:
369 	input_free_device(input_dev);
370 	kfree(data);
371 err_out:
372 	return ERR_PTR(error);
373 }
374 EXPORT_SYMBOL(cma3000_init);
375 
cma3000_exit(struct cma3000_accl_data * data)376 void cma3000_exit(struct cma3000_accl_data *data)
377 {
378 	free_irq(data->irq, data);
379 	input_unregister_device(data->input_dev);
380 	kfree(data);
381 }
382 EXPORT_SYMBOL(cma3000_exit);
383 
384 MODULE_DESCRIPTION("CMA3000-D0x Accelerometer Driver");
385 MODULE_LICENSE("GPL");
386 MODULE_AUTHOR("Hemanth V <hemanthv@ti.com>");
387