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 238e27c7292SMichael Hennerich static void adxl34x_get_triple(struct adxl34x *ac, struct axis_triple *axis) 239e27c7292SMichael Hennerich { 240e27c7292SMichael Hennerich short 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 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 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 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 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 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 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 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 415af6e1d99SDmitry Torokhov void adxl34x_suspend(struct adxl34x *ac) 416e27c7292SMichael Hennerich { 417e27c7292SMichael Hennerich mutex_lock(&ac->mutex); 418af6e1d99SDmitry Torokhov 419af6e1d99SDmitry Torokhov if (!ac->suspended && !ac->disabled && ac->opened) 420e27c7292SMichael Hennerich __adxl34x_disable(ac); 421af6e1d99SDmitry Torokhov 422af6e1d99SDmitry Torokhov ac->suspended = true; 423af6e1d99SDmitry Torokhov 424e27c7292SMichael Hennerich mutex_unlock(&ac->mutex); 425e27c7292SMichael Hennerich } 426af6e1d99SDmitry Torokhov EXPORT_SYMBOL_GPL(adxl34x_suspend); 427e27c7292SMichael Hennerich 428af6e1d99SDmitry Torokhov void adxl34x_resume(struct adxl34x *ac) 429e27c7292SMichael Hennerich { 430e27c7292SMichael Hennerich mutex_lock(&ac->mutex); 431af6e1d99SDmitry Torokhov 432af6e1d99SDmitry Torokhov if (ac->suspended && !ac->disabled && ac->opened) 433e27c7292SMichael Hennerich __adxl34x_enable(ac); 434af6e1d99SDmitry Torokhov 435af6e1d99SDmitry Torokhov ac->suspended = false; 436af6e1d99SDmitry Torokhov 437e27c7292SMichael Hennerich mutex_unlock(&ac->mutex); 438e27c7292SMichael Hennerich } 439af6e1d99SDmitry Torokhov EXPORT_SYMBOL_GPL(adxl34x_resume); 440e27c7292SMichael Hennerich 441e27c7292SMichael Hennerich static ssize_t adxl34x_disable_show(struct device *dev, 442e27c7292SMichael Hennerich struct device_attribute *attr, char *buf) 443e27c7292SMichael Hennerich { 444e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev); 445e27c7292SMichael Hennerich 446e27c7292SMichael Hennerich return sprintf(buf, "%u\n", ac->disabled); 447e27c7292SMichael Hennerich } 448e27c7292SMichael Hennerich 449e27c7292SMichael Hennerich static ssize_t adxl34x_disable_store(struct device *dev, 450e27c7292SMichael Hennerich struct device_attribute *attr, 451e27c7292SMichael Hennerich const char *buf, size_t count) 452e27c7292SMichael Hennerich { 453e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev); 45476496e7aSJJ Ding unsigned int val; 455e27c7292SMichael Hennerich int error; 456e27c7292SMichael Hennerich 45776496e7aSJJ Ding error = kstrtouint(buf, 10, &val); 458e27c7292SMichael Hennerich if (error) 459e27c7292SMichael Hennerich return error; 460e27c7292SMichael Hennerich 461af6e1d99SDmitry Torokhov mutex_lock(&ac->mutex); 462af6e1d99SDmitry Torokhov 463af6e1d99SDmitry Torokhov if (!ac->suspended && ac->opened) { 464af6e1d99SDmitry Torokhov if (val) { 465af6e1d99SDmitry Torokhov if (!ac->disabled) 466af6e1d99SDmitry Torokhov __adxl34x_disable(ac); 467af6e1d99SDmitry Torokhov } else { 468af6e1d99SDmitry Torokhov if (ac->disabled) 469af6e1d99SDmitry Torokhov __adxl34x_enable(ac); 470af6e1d99SDmitry Torokhov } 471af6e1d99SDmitry Torokhov } 472af6e1d99SDmitry Torokhov 473af6e1d99SDmitry Torokhov ac->disabled = !!val; 474af6e1d99SDmitry Torokhov 475af6e1d99SDmitry Torokhov mutex_unlock(&ac->mutex); 476e27c7292SMichael Hennerich 477e27c7292SMichael Hennerich return count; 478e27c7292SMichael Hennerich } 479e27c7292SMichael Hennerich 480e27c7292SMichael Hennerich static DEVICE_ATTR(disable, 0664, adxl34x_disable_show, adxl34x_disable_store); 481e27c7292SMichael Hennerich 482e27c7292SMichael Hennerich static ssize_t adxl34x_calibrate_show(struct device *dev, 483e27c7292SMichael Hennerich struct device_attribute *attr, char *buf) 484e27c7292SMichael Hennerich { 485e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev); 486e27c7292SMichael Hennerich ssize_t count; 487e27c7292SMichael Hennerich 488e27c7292SMichael Hennerich mutex_lock(&ac->mutex); 489e27c7292SMichael Hennerich count = sprintf(buf, "%d,%d,%d\n", 490e27c7292SMichael Hennerich ac->hwcal.x * 4 + ac->swcal.x, 491e27c7292SMichael Hennerich ac->hwcal.y * 4 + ac->swcal.y, 492e27c7292SMichael Hennerich ac->hwcal.z * 4 + ac->swcal.z); 493e27c7292SMichael Hennerich mutex_unlock(&ac->mutex); 494e27c7292SMichael Hennerich 495e27c7292SMichael Hennerich return count; 496e27c7292SMichael Hennerich } 497e27c7292SMichael Hennerich 498e27c7292SMichael Hennerich static ssize_t adxl34x_calibrate_store(struct device *dev, 499e27c7292SMichael Hennerich struct device_attribute *attr, 500e27c7292SMichael Hennerich const char *buf, size_t count) 501e27c7292SMichael Hennerich { 502e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev); 503e27c7292SMichael Hennerich 504e27c7292SMichael Hennerich /* 505e27c7292SMichael Hennerich * Hardware offset calibration has a resolution of 15.6 mg/LSB. 506e27c7292SMichael Hennerich * We use HW calibration and handle the remaining bits in SW. (4mg/LSB) 507e27c7292SMichael Hennerich */ 508e27c7292SMichael Hennerich 509e27c7292SMichael Hennerich mutex_lock(&ac->mutex); 510e27c7292SMichael Hennerich ac->hwcal.x -= (ac->saved.x / 4); 511e27c7292SMichael Hennerich ac->swcal.x = ac->saved.x % 4; 512e27c7292SMichael Hennerich 513e27c7292SMichael Hennerich ac->hwcal.y -= (ac->saved.y / 4); 514e27c7292SMichael Hennerich ac->swcal.y = ac->saved.y % 4; 515e27c7292SMichael Hennerich 516e27c7292SMichael Hennerich ac->hwcal.z -= (ac->saved.z / 4); 517e27c7292SMichael Hennerich ac->swcal.z = ac->saved.z % 4; 518e27c7292SMichael Hennerich 519e27c7292SMichael Hennerich AC_WRITE(ac, OFSX, (s8) ac->hwcal.x); 520e27c7292SMichael Hennerich AC_WRITE(ac, OFSY, (s8) ac->hwcal.y); 521e27c7292SMichael Hennerich AC_WRITE(ac, OFSZ, (s8) ac->hwcal.z); 522e27c7292SMichael Hennerich mutex_unlock(&ac->mutex); 523e27c7292SMichael Hennerich 524e27c7292SMichael Hennerich return count; 525e27c7292SMichael Hennerich } 526e27c7292SMichael Hennerich 527e27c7292SMichael Hennerich static DEVICE_ATTR(calibrate, 0664, 528e27c7292SMichael Hennerich adxl34x_calibrate_show, adxl34x_calibrate_store); 529e27c7292SMichael Hennerich 530e27c7292SMichael Hennerich static ssize_t adxl34x_rate_show(struct device *dev, 531e27c7292SMichael Hennerich struct device_attribute *attr, char *buf) 532e27c7292SMichael Hennerich { 533e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev); 534e27c7292SMichael Hennerich 535e27c7292SMichael Hennerich return sprintf(buf, "%u\n", RATE(ac->pdata.data_rate)); 536e27c7292SMichael Hennerich } 537e27c7292SMichael Hennerich 538e27c7292SMichael Hennerich static ssize_t adxl34x_rate_store(struct device *dev, 539e27c7292SMichael Hennerich struct device_attribute *attr, 540e27c7292SMichael Hennerich const char *buf, size_t count) 541e27c7292SMichael Hennerich { 542e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev); 54376496e7aSJJ Ding unsigned char val; 544e27c7292SMichael Hennerich int error; 545e27c7292SMichael Hennerich 54676496e7aSJJ Ding error = kstrtou8(buf, 10, &val); 547e27c7292SMichael Hennerich if (error) 548e27c7292SMichael Hennerich return error; 549e27c7292SMichael Hennerich 550e27c7292SMichael Hennerich mutex_lock(&ac->mutex); 551e27c7292SMichael Hennerich 552e27c7292SMichael Hennerich ac->pdata.data_rate = RATE(val); 553e27c7292SMichael Hennerich AC_WRITE(ac, BW_RATE, 554e27c7292SMichael Hennerich ac->pdata.data_rate | 555e27c7292SMichael Hennerich (ac->pdata.low_power_mode ? LOW_POWER : 0)); 556e27c7292SMichael Hennerich 557e27c7292SMichael Hennerich mutex_unlock(&ac->mutex); 558e27c7292SMichael Hennerich 559e27c7292SMichael Hennerich return count; 560e27c7292SMichael Hennerich } 561e27c7292SMichael Hennerich 562e27c7292SMichael Hennerich static DEVICE_ATTR(rate, 0664, adxl34x_rate_show, adxl34x_rate_store); 563e27c7292SMichael Hennerich 564e27c7292SMichael Hennerich static ssize_t adxl34x_autosleep_show(struct device *dev, 565e27c7292SMichael Hennerich struct device_attribute *attr, char *buf) 566e27c7292SMichael Hennerich { 567e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev); 568e27c7292SMichael Hennerich 569e27c7292SMichael Hennerich return sprintf(buf, "%u\n", 570e27c7292SMichael Hennerich ac->pdata.power_mode & (PCTL_AUTO_SLEEP | PCTL_LINK) ? 1 : 0); 571e27c7292SMichael Hennerich } 572e27c7292SMichael Hennerich 573e27c7292SMichael Hennerich static ssize_t adxl34x_autosleep_store(struct device *dev, 574e27c7292SMichael Hennerich struct device_attribute *attr, 575e27c7292SMichael Hennerich const char *buf, size_t count) 576e27c7292SMichael Hennerich { 577e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev); 57876496e7aSJJ Ding unsigned int val; 579e27c7292SMichael Hennerich int error; 580e27c7292SMichael Hennerich 58176496e7aSJJ Ding error = kstrtouint(buf, 10, &val); 582e27c7292SMichael Hennerich if (error) 583e27c7292SMichael Hennerich return error; 584e27c7292SMichael Hennerich 585e27c7292SMichael Hennerich mutex_lock(&ac->mutex); 586e27c7292SMichael Hennerich 587e27c7292SMichael Hennerich if (val) 588e27c7292SMichael Hennerich ac->pdata.power_mode |= (PCTL_AUTO_SLEEP | PCTL_LINK); 589e27c7292SMichael Hennerich else 590e27c7292SMichael Hennerich ac->pdata.power_mode &= ~(PCTL_AUTO_SLEEP | PCTL_LINK); 591e27c7292SMichael Hennerich 592af6e1d99SDmitry Torokhov if (!ac->disabled && !ac->suspended && ac->opened) 593e27c7292SMichael Hennerich AC_WRITE(ac, POWER_CTL, ac->pdata.power_mode | PCTL_MEASURE); 594e27c7292SMichael Hennerich 595e27c7292SMichael Hennerich mutex_unlock(&ac->mutex); 596e27c7292SMichael Hennerich 597e27c7292SMichael Hennerich return count; 598e27c7292SMichael Hennerich } 599e27c7292SMichael Hennerich 600e27c7292SMichael Hennerich static DEVICE_ATTR(autosleep, 0664, 601e27c7292SMichael Hennerich adxl34x_autosleep_show, adxl34x_autosleep_store); 602e27c7292SMichael Hennerich 603e27c7292SMichael Hennerich static ssize_t adxl34x_position_show(struct device *dev, 604e27c7292SMichael Hennerich struct device_attribute *attr, char *buf) 605e27c7292SMichael Hennerich { 606e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev); 607e27c7292SMichael Hennerich ssize_t count; 608e27c7292SMichael Hennerich 609e27c7292SMichael Hennerich mutex_lock(&ac->mutex); 610e27c7292SMichael Hennerich count = sprintf(buf, "(%d, %d, %d)\n", 611e27c7292SMichael Hennerich ac->saved.x, ac->saved.y, ac->saved.z); 612e27c7292SMichael Hennerich mutex_unlock(&ac->mutex); 613e27c7292SMichael Hennerich 614e27c7292SMichael Hennerich return count; 615e27c7292SMichael Hennerich } 616e27c7292SMichael Hennerich 617e27c7292SMichael Hennerich static DEVICE_ATTR(position, S_IRUGO, adxl34x_position_show, NULL); 618e27c7292SMichael Hennerich 619e27c7292SMichael Hennerich #ifdef ADXL_DEBUG 620e27c7292SMichael Hennerich static ssize_t adxl34x_write_store(struct device *dev, 621e27c7292SMichael Hennerich struct device_attribute *attr, 622e27c7292SMichael Hennerich const char *buf, size_t count) 623e27c7292SMichael Hennerich { 624e27c7292SMichael Hennerich struct adxl34x *ac = dev_get_drvdata(dev); 62576496e7aSJJ Ding unsigned int val; 626e27c7292SMichael Hennerich int error; 627e27c7292SMichael Hennerich 628e27c7292SMichael Hennerich /* 629e27c7292SMichael Hennerich * This allows basic ADXL register write access for debug purposes. 630e27c7292SMichael Hennerich */ 63176496e7aSJJ Ding error = kstrtouint(buf, 16, &val); 632e27c7292SMichael Hennerich if (error) 633e27c7292SMichael Hennerich return error; 634e27c7292SMichael Hennerich 635e27c7292SMichael Hennerich mutex_lock(&ac->mutex); 636e27c7292SMichael Hennerich AC_WRITE(ac, val >> 8, val & 0xFF); 637e27c7292SMichael Hennerich mutex_unlock(&ac->mutex); 638e27c7292SMichael Hennerich 639e27c7292SMichael Hennerich return count; 640e27c7292SMichael Hennerich } 641e27c7292SMichael Hennerich 642e27c7292SMichael Hennerich static DEVICE_ATTR(write, 0664, NULL, adxl34x_write_store); 643e27c7292SMichael Hennerich #endif 644e27c7292SMichael Hennerich 645e27c7292SMichael Hennerich static struct attribute *adxl34x_attributes[] = { 646e27c7292SMichael Hennerich &dev_attr_disable.attr, 647e27c7292SMichael Hennerich &dev_attr_calibrate.attr, 648e27c7292SMichael Hennerich &dev_attr_rate.attr, 649e27c7292SMichael Hennerich &dev_attr_autosleep.attr, 650e27c7292SMichael Hennerich &dev_attr_position.attr, 651e27c7292SMichael Hennerich #ifdef ADXL_DEBUG 652e27c7292SMichael Hennerich &dev_attr_write.attr, 653e27c7292SMichael Hennerich #endif 654e27c7292SMichael Hennerich NULL 655e27c7292SMichael Hennerich }; 656e27c7292SMichael Hennerich 657e27c7292SMichael Hennerich static const struct attribute_group adxl34x_attr_group = { 658e27c7292SMichael Hennerich .attrs = adxl34x_attributes, 659e27c7292SMichael Hennerich }; 660e27c7292SMichael Hennerich 661e27c7292SMichael Hennerich static int adxl34x_input_open(struct input_dev *input) 662e27c7292SMichael Hennerich { 663e27c7292SMichael Hennerich struct adxl34x *ac = input_get_drvdata(input); 664e27c7292SMichael Hennerich 665e27c7292SMichael Hennerich mutex_lock(&ac->mutex); 666af6e1d99SDmitry Torokhov 667af6e1d99SDmitry Torokhov if (!ac->suspended && !ac->disabled) 668e27c7292SMichael Hennerich __adxl34x_enable(ac); 669af6e1d99SDmitry Torokhov 670af6e1d99SDmitry Torokhov ac->opened = true; 671af6e1d99SDmitry Torokhov 672e27c7292SMichael Hennerich mutex_unlock(&ac->mutex); 673e27c7292SMichael Hennerich 674e27c7292SMichael Hennerich return 0; 675e27c7292SMichael Hennerich } 676e27c7292SMichael Hennerich 677e27c7292SMichael Hennerich static void adxl34x_input_close(struct input_dev *input) 678e27c7292SMichael Hennerich { 679e27c7292SMichael Hennerich struct adxl34x *ac = input_get_drvdata(input); 680e27c7292SMichael Hennerich 681e27c7292SMichael Hennerich mutex_lock(&ac->mutex); 682af6e1d99SDmitry Torokhov 683af6e1d99SDmitry Torokhov if (!ac->suspended && !ac->disabled) 684e27c7292SMichael Hennerich __adxl34x_disable(ac); 685af6e1d99SDmitry Torokhov 686e27c7292SMichael Hennerich ac->opened = false; 687af6e1d99SDmitry Torokhov 688e27c7292SMichael Hennerich mutex_unlock(&ac->mutex); 689e27c7292SMichael Hennerich } 690e27c7292SMichael Hennerich 691e27c7292SMichael Hennerich struct adxl34x *adxl34x_probe(struct device *dev, int irq, 692e27c7292SMichael Hennerich bool fifo_delay_default, 693e27c7292SMichael Hennerich const struct adxl34x_bus_ops *bops) 694e27c7292SMichael Hennerich { 695e27c7292SMichael Hennerich struct adxl34x *ac; 696e27c7292SMichael Hennerich struct input_dev *input_dev; 697e27c7292SMichael Hennerich const struct adxl34x_platform_data *pdata; 698671386bbSMichael Hennerich int err, range, i; 69933b6c39eSDan Carpenter int revid; 700e27c7292SMichael Hennerich 701e27c7292SMichael Hennerich if (!irq) { 702e27c7292SMichael Hennerich dev_err(dev, "no IRQ?\n"); 703e27c7292SMichael Hennerich err = -ENODEV; 704e27c7292SMichael Hennerich goto err_out; 705e27c7292SMichael Hennerich } 706e27c7292SMichael Hennerich 707e27c7292SMichael Hennerich ac = kzalloc(sizeof(*ac), GFP_KERNEL); 708e27c7292SMichael Hennerich input_dev = input_allocate_device(); 709e27c7292SMichael Hennerich if (!ac || !input_dev) { 710e27c7292SMichael Hennerich err = -ENOMEM; 711f1cba532SDan Carpenter goto err_free_mem; 712e27c7292SMichael Hennerich } 713e27c7292SMichael Hennerich 714e27c7292SMichael Hennerich ac->fifo_delay = fifo_delay_default; 715e27c7292SMichael Hennerich 716c838cb3dSJingoo Han pdata = dev_get_platdata(dev); 717e27c7292SMichael Hennerich if (!pdata) { 718e27c7292SMichael Hennerich dev_dbg(dev, 71925985edcSLucas De Marchi "No platform data: Using default initialization\n"); 720e27c7292SMichael Hennerich pdata = &adxl34x_default_init; 721e27c7292SMichael Hennerich } 722e27c7292SMichael Hennerich 723e27c7292SMichael Hennerich ac->pdata = *pdata; 724e27c7292SMichael Hennerich pdata = &ac->pdata; 725e27c7292SMichael Hennerich 726e27c7292SMichael Hennerich ac->input = input_dev; 727e27c7292SMichael Hennerich ac->dev = dev; 728e27c7292SMichael Hennerich ac->irq = irq; 729e27c7292SMichael Hennerich ac->bops = bops; 730e27c7292SMichael Hennerich 731e27c7292SMichael Hennerich mutex_init(&ac->mutex); 732e27c7292SMichael Hennerich 733e27c7292SMichael Hennerich input_dev->name = "ADXL34x accelerometer"; 734ad4e58b0SWolfram Sang revid = AC_READ(ac, DEVID); 735e27c7292SMichael Hennerich 736e27c7292SMichael Hennerich switch (revid) { 737e27c7292SMichael Hennerich case ID_ADXL345: 738e27c7292SMichael Hennerich ac->model = 345; 739e27c7292SMichael Hennerich break; 740e27c7292SMichael Hennerich case ID_ADXL346: 741e27c7292SMichael Hennerich ac->model = 346; 742e27c7292SMichael Hennerich break; 743e27c7292SMichael Hennerich default: 744e27c7292SMichael Hennerich dev_err(dev, "Failed to probe %s\n", input_dev->name); 745e27c7292SMichael Hennerich err = -ENODEV; 746e27c7292SMichael Hennerich goto err_free_mem; 747e27c7292SMichael Hennerich } 748e27c7292SMichael Hennerich 749e27c7292SMichael Hennerich snprintf(ac->phys, sizeof(ac->phys), "%s/input0", dev_name(dev)); 750e27c7292SMichael Hennerich 751e27c7292SMichael Hennerich input_dev->phys = ac->phys; 752e27c7292SMichael Hennerich input_dev->dev.parent = dev; 753e27c7292SMichael Hennerich input_dev->id.product = ac->model; 754e27c7292SMichael Hennerich input_dev->id.bustype = bops->bustype; 755e27c7292SMichael Hennerich input_dev->open = adxl34x_input_open; 756e27c7292SMichael Hennerich input_dev->close = adxl34x_input_close; 757e27c7292SMichael Hennerich 758e27c7292SMichael Hennerich input_set_drvdata(input_dev, ac); 759e27c7292SMichael Hennerich 760e27c7292SMichael Hennerich __set_bit(ac->pdata.ev_type, input_dev->evbit); 761e27c7292SMichael Hennerich 762e27c7292SMichael Hennerich if (ac->pdata.ev_type == EV_REL) { 763e27c7292SMichael Hennerich __set_bit(REL_X, input_dev->relbit); 764e27c7292SMichael Hennerich __set_bit(REL_Y, input_dev->relbit); 765e27c7292SMichael Hennerich __set_bit(REL_Z, input_dev->relbit); 766e27c7292SMichael Hennerich } else { 767e27c7292SMichael Hennerich /* EV_ABS */ 768e27c7292SMichael Hennerich __set_bit(ABS_X, input_dev->absbit); 769e27c7292SMichael Hennerich __set_bit(ABS_Y, input_dev->absbit); 770e27c7292SMichael Hennerich __set_bit(ABS_Z, input_dev->absbit); 771e27c7292SMichael Hennerich 772e27c7292SMichael Hennerich if (pdata->data_range & FULL_RES) 773e27c7292SMichael Hennerich range = ADXL_FULLRES_MAX_VAL; /* Signed 13-bit */ 774e27c7292SMichael Hennerich else 775e27c7292SMichael Hennerich range = ADXL_FIXEDRES_MAX_VAL; /* Signed 10-bit */ 776e27c7292SMichael Hennerich 777e27c7292SMichael Hennerich input_set_abs_params(input_dev, ABS_X, -range, range, 3, 3); 778e27c7292SMichael Hennerich input_set_abs_params(input_dev, ABS_Y, -range, range, 3, 3); 779e27c7292SMichael Hennerich input_set_abs_params(input_dev, ABS_Z, -range, range, 3, 3); 780e27c7292SMichael Hennerich } 781e27c7292SMichael Hennerich 782e27c7292SMichael Hennerich __set_bit(EV_KEY, input_dev->evbit); 783e27c7292SMichael Hennerich __set_bit(pdata->ev_code_tap[ADXL_X_AXIS], input_dev->keybit); 784e27c7292SMichael Hennerich __set_bit(pdata->ev_code_tap[ADXL_Y_AXIS], input_dev->keybit); 785e27c7292SMichael Hennerich __set_bit(pdata->ev_code_tap[ADXL_Z_AXIS], input_dev->keybit); 786e27c7292SMichael Hennerich 787e27c7292SMichael Hennerich if (pdata->ev_code_ff) { 788e27c7292SMichael Hennerich ac->int_mask = FREE_FALL; 789e27c7292SMichael Hennerich __set_bit(pdata->ev_code_ff, input_dev->keybit); 790e27c7292SMichael Hennerich } 791e27c7292SMichael Hennerich 792e27c7292SMichael Hennerich if (pdata->ev_code_act_inactivity) 793e27c7292SMichael Hennerich __set_bit(pdata->ev_code_act_inactivity, input_dev->keybit); 794e27c7292SMichael Hennerich 795e27c7292SMichael Hennerich ac->int_mask |= ACTIVITY | INACTIVITY; 796e27c7292SMichael Hennerich 797e27c7292SMichael Hennerich if (pdata->watermark) { 798e27c7292SMichael Hennerich ac->int_mask |= WATERMARK; 7991dbc080cSArnd Bergmann if (FIFO_MODE(pdata->fifo_mode) == FIFO_BYPASS) 800e27c7292SMichael Hennerich ac->pdata.fifo_mode |= FIFO_STREAM; 801e27c7292SMichael Hennerich } else { 802e27c7292SMichael Hennerich ac->int_mask |= DATA_READY; 803e27c7292SMichael Hennerich } 804e27c7292SMichael Hennerich 805e27c7292SMichael Hennerich if (pdata->tap_axis_control & (TAP_X_EN | TAP_Y_EN | TAP_Z_EN)) 806e27c7292SMichael Hennerich ac->int_mask |= SINGLE_TAP | DOUBLE_TAP; 807e27c7292SMichael Hennerich 808e27c7292SMichael Hennerich if (FIFO_MODE(pdata->fifo_mode) == FIFO_BYPASS) 809e27c7292SMichael Hennerich ac->fifo_delay = false; 810e27c7292SMichael Hennerich 811ad4e58b0SWolfram Sang AC_WRITE(ac, POWER_CTL, 0); 812e27c7292SMichael Hennerich 813e27c7292SMichael Hennerich err = request_threaded_irq(ac->irq, NULL, adxl34x_irq, 814e27c7292SMichael Hennerich IRQF_TRIGGER_HIGH | IRQF_ONESHOT, 815e27c7292SMichael Hennerich dev_name(dev), ac); 816e27c7292SMichael Hennerich if (err) { 817e27c7292SMichael Hennerich dev_err(dev, "irq %d busy?\n", ac->irq); 818e27c7292SMichael Hennerich goto err_free_mem; 819e27c7292SMichael Hennerich } 820e27c7292SMichael Hennerich 821e27c7292SMichael Hennerich err = sysfs_create_group(&dev->kobj, &adxl34x_attr_group); 822e27c7292SMichael Hennerich if (err) 823e27c7292SMichael Hennerich goto err_free_irq; 824e27c7292SMichael Hennerich 825e27c7292SMichael Hennerich err = input_register_device(input_dev); 826e27c7292SMichael Hennerich if (err) 827e27c7292SMichael Hennerich goto err_remove_attr; 828e27c7292SMichael Hennerich 829e27c7292SMichael Hennerich AC_WRITE(ac, OFSX, pdata->x_axis_offset); 830e27c7292SMichael Hennerich ac->hwcal.x = pdata->x_axis_offset; 831e27c7292SMichael Hennerich AC_WRITE(ac, OFSY, pdata->y_axis_offset); 832e27c7292SMichael Hennerich ac->hwcal.y = pdata->y_axis_offset; 833e27c7292SMichael Hennerich AC_WRITE(ac, OFSZ, pdata->z_axis_offset); 834e27c7292SMichael Hennerich ac->hwcal.z = pdata->z_axis_offset; 835e27c7292SMichael Hennerich AC_WRITE(ac, THRESH_TAP, pdata->tap_threshold); 836e27c7292SMichael Hennerich AC_WRITE(ac, DUR, pdata->tap_duration); 837e27c7292SMichael Hennerich AC_WRITE(ac, LATENT, pdata->tap_latency); 838e27c7292SMichael Hennerich AC_WRITE(ac, WINDOW, pdata->tap_window); 839e27c7292SMichael Hennerich AC_WRITE(ac, THRESH_ACT, pdata->activity_threshold); 840e27c7292SMichael Hennerich AC_WRITE(ac, THRESH_INACT, pdata->inactivity_threshold); 841e27c7292SMichael Hennerich AC_WRITE(ac, TIME_INACT, pdata->inactivity_time); 842e27c7292SMichael Hennerich AC_WRITE(ac, THRESH_FF, pdata->free_fall_threshold); 843e27c7292SMichael Hennerich AC_WRITE(ac, TIME_FF, pdata->free_fall_time); 844e27c7292SMichael Hennerich AC_WRITE(ac, TAP_AXES, pdata->tap_axis_control); 845e27c7292SMichael Hennerich AC_WRITE(ac, ACT_INACT_CTL, pdata->act_axis_control); 846e27c7292SMichael Hennerich AC_WRITE(ac, BW_RATE, RATE(ac->pdata.data_rate) | 847e27c7292SMichael Hennerich (pdata->low_power_mode ? LOW_POWER : 0)); 848e27c7292SMichael Hennerich AC_WRITE(ac, DATA_FORMAT, pdata->data_range); 849e27c7292SMichael Hennerich AC_WRITE(ac, FIFO_CTL, FIFO_MODE(pdata->fifo_mode) | 850e27c7292SMichael Hennerich SAMPLES(pdata->watermark)); 851e27c7292SMichael Hennerich 852671386bbSMichael Hennerich if (pdata->use_int2) { 853e27c7292SMichael Hennerich /* Map all INTs to INT2 */ 854e27c7292SMichael Hennerich AC_WRITE(ac, INT_MAP, ac->int_mask | OVERRUN); 855671386bbSMichael Hennerich } else { 856e27c7292SMichael Hennerich /* Map all INTs to INT1 */ 857e27c7292SMichael Hennerich AC_WRITE(ac, INT_MAP, 0); 858671386bbSMichael Hennerich } 859671386bbSMichael Hennerich 860671386bbSMichael Hennerich if (ac->model == 346 && ac->pdata.orientation_enable) { 861671386bbSMichael Hennerich AC_WRITE(ac, ORIENT_CONF, 862671386bbSMichael Hennerich ORIENT_DEADZONE(ac->pdata.deadzone_angle) | 863671386bbSMichael Hennerich ORIENT_DIVISOR(ac->pdata.divisor_length)); 864671386bbSMichael Hennerich 865671386bbSMichael Hennerich ac->orient2d_saved = 1234; 866671386bbSMichael Hennerich ac->orient3d_saved = 1234; 867671386bbSMichael Hennerich 868671386bbSMichael Hennerich if (pdata->orientation_enable & ADXL_EN_ORIENTATION_3D) 869671386bbSMichael Hennerich for (i = 0; i < ARRAY_SIZE(pdata->ev_codes_orient_3d); i++) 870671386bbSMichael Hennerich __set_bit(pdata->ev_codes_orient_3d[i], 871671386bbSMichael Hennerich input_dev->keybit); 872671386bbSMichael Hennerich 873671386bbSMichael Hennerich if (pdata->orientation_enable & ADXL_EN_ORIENTATION_2D) 874671386bbSMichael Hennerich for (i = 0; i < ARRAY_SIZE(pdata->ev_codes_orient_2d); i++) 875671386bbSMichael Hennerich __set_bit(pdata->ev_codes_orient_2d[i], 876671386bbSMichael Hennerich input_dev->keybit); 877671386bbSMichael Hennerich } else { 878671386bbSMichael Hennerich ac->pdata.orientation_enable = 0; 879671386bbSMichael Hennerich } 880e27c7292SMichael Hennerich 881e27c7292SMichael Hennerich AC_WRITE(ac, INT_ENABLE, ac->int_mask | OVERRUN); 882e27c7292SMichael Hennerich 883e27c7292SMichael Hennerich ac->pdata.power_mode &= (PCTL_AUTO_SLEEP | PCTL_LINK); 884e27c7292SMichael Hennerich 885e27c7292SMichael Hennerich return ac; 886e27c7292SMichael Hennerich 887e27c7292SMichael Hennerich err_remove_attr: 888e27c7292SMichael Hennerich sysfs_remove_group(&dev->kobj, &adxl34x_attr_group); 889e27c7292SMichael Hennerich err_free_irq: 890e27c7292SMichael Hennerich free_irq(ac->irq, ac); 891e27c7292SMichael Hennerich err_free_mem: 892e27c7292SMichael Hennerich input_free_device(input_dev); 893e27c7292SMichael Hennerich kfree(ac); 894e27c7292SMichael Hennerich err_out: 895e27c7292SMichael Hennerich return ERR_PTR(err); 896e27c7292SMichael Hennerich } 897e27c7292SMichael Hennerich EXPORT_SYMBOL_GPL(adxl34x_probe); 898e27c7292SMichael Hennerich 899*af98ff04SUwe Kleine-König void adxl34x_remove(struct adxl34x *ac) 900e27c7292SMichael Hennerich { 901e27c7292SMichael Hennerich sysfs_remove_group(&ac->dev->kobj, &adxl34x_attr_group); 902e27c7292SMichael Hennerich free_irq(ac->irq, ac); 903e27c7292SMichael Hennerich input_unregister_device(ac->input); 904f1cba532SDan Carpenter dev_dbg(ac->dev, "unregistered accelerometer\n"); 905e27c7292SMichael Hennerich kfree(ac); 906e27c7292SMichael Hennerich } 907e27c7292SMichael Hennerich EXPORT_SYMBOL_GPL(adxl34x_remove); 908e27c7292SMichael Hennerich 909e27c7292SMichael Hennerich MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>"); 910e27c7292SMichael Hennerich MODULE_DESCRIPTION("ADXL345/346 Three-Axis Digital Accelerometer Driver"); 911e27c7292SMichael Hennerich MODULE_LICENSE("GPL"); 912