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