release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/staging/iio/accel/lis3l02dq_core.c

   1 /*
   2  * lis3l02dq.c  support STMicroelectronics LISD02DQ
   3  *              3d 2g Linear Accelerometers via SPI
   4  *
   5  * Copyright (c) 2007 Jonathan Cameron <jic23@cam.ac.uk>
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License version 2 as
   9  * published by the Free Software Foundation.
  10  *
  11  * Settings:
  12  * 16 bit left justified mode used.
  13  */
  14
  15 #include <linux/interrupt.h>
  16 #include <linux/irq.h>
  17 #include <linux/gpio.h>
  18 #include <linux/workqueue.h>
  19 #include <linux/mutex.h>
  20 #include <linux/device.h>
  21 #include <linux/kernel.h>
  22 #include <linux/spi/spi.h>
  23 #include <linux/slab.h>
  24
  25 #include <linux/sysfs.h>
  26 #include <linux/list.h>
  27
  28 #include "../iio.h"
  29 #include "../sysfs.h"
  30 #include "../ring_generic.h"
  31 #include "../ring_sw.h"
  32
  33 #include "accel.h"
  34
  35 #include "lis3l02dq.h"
  36
  37 /* At the moment the spi framework doesn't allow global setting of cs_change.
  38  * It's in the likely to be added comment at the top of spi.h.
  39  * This means that use cannot be made of spi_write etc.
  40  */
  41
  42 /**
  43  * lis3l02dq_spi_read_reg_8() - read single byte from a single register
  44  * @dev: device asosciated with child of actual device (iio_dev or iio_trig)
  45  * @reg_address: the address of the register to be read
  46  * @val: pass back the resulting value
  47  **/
  48 int lis3l02dq_spi_read_reg_8(struct device *dev, u8 reg_address, u8 *val)
  49 {
  50         int ret;
  51         struct spi_message msg;
  52         struct iio_dev *indio_dev = dev_get_drvdata(dev);
  53         struct iio_sw_ring_helper_state *h = iio_dev_get_devdata(indio_dev);
  54         struct lis3l02dq_state *st = lis3l02dq_h_to_s(h);
  55
  56         struct spi_transfer xfer = {
  57                 .tx_buf = st->tx,
  58                 .rx_buf = st->rx,
  59                 .bits_per_word = 8,
  60                 .len = 2,
  61                 .cs_change = 1,
  62         };
  63
  64         mutex_lock(&st->buf_lock);
  65         st->tx[0] = LIS3L02DQ_READ_REG(reg_address);
  66         st->tx[1] = 0;
  67
  68         spi_message_init(&msg);
  69         spi_message_add_tail(&xfer, &msg);
  70         ret = spi_sync(st->us, &msg);
  71         *val = st->rx[1];
  72         mutex_unlock(&st->buf_lock);
  73
  74         return ret;
  75 }
  76
  77 /**
  78  * lis3l02dq_spi_write_reg_8() - write single byte to a register
  79  * @dev: device associated with child of actual device (iio_dev or iio_trig)
  80  * @reg_address: the address of the register to be writen
  81  * @val: the value to write
  82  **/
  83 int lis3l02dq_spi_write_reg_8(struct device *dev,
  84                               u8 reg_address,
  85                               u8 *val)
  86 {
  87         int ret;
  88         struct spi_message msg;
  89         struct iio_dev *indio_dev = dev_get_drvdata(dev);
  90         struct iio_sw_ring_helper_state *h
  91                 = iio_dev_get_devdata(indio_dev);
  92         struct lis3l02dq_state *st = lis3l02dq_h_to_s(h);
  93         struct spi_transfer xfer = {
  94                 .tx_buf = st->tx,
  95                 .bits_per_word = 8,
  96                 .len = 2,
  97                 .cs_change = 1,
  98         };
  99
 100         mutex_lock(&st->buf_lock);
 101         st->tx[0] = LIS3L02DQ_WRITE_REG(reg_address);
 102         st->tx[1] = *val;
 103
 104         spi_message_init(&msg);
 105         spi_message_add_tail(&xfer, &msg);
 106         ret = spi_sync(st->us, &msg);
 107         mutex_unlock(&st->buf_lock);
 108
 109         return ret;
 110 }
 111
 112 /**
 113  * lisl302dq_spi_write_reg_s16() - write 2 bytes to a pair of registers
 114  * @dev: device associated with child of actual device (iio_dev or iio_trig)
 115  * @reg_address: the address of the lower of the two registers. Second register
 116  *               is assumed to have address one greater.
 117  * @val: value to be written
 118  **/
 119 static int lis3l02dq_spi_write_reg_s16(struct device *dev,
 120                                        u8 lower_reg_address,
 121                                        s16 value)
 122 {
 123         int ret;
 124         struct spi_message msg;
 125         struct iio_dev *indio_dev = dev_get_drvdata(dev);
 126         struct iio_sw_ring_helper_state *h
 127                 = iio_dev_get_devdata(indio_dev);
 128         struct lis3l02dq_state *st = lis3l02dq_h_to_s(h);
 129         struct spi_transfer xfers[] = { {
 130                         .tx_buf = st->tx,
 131                         .bits_per_word = 8,
 132                         .len = 2,
 133                         .cs_change = 1,
 134                 }, {
 135                         .tx_buf = st->tx + 2,
 136                         .bits_per_word = 8,
 137                         .len = 2,
 138                         .cs_change = 1,
 139                 },
 140         };
 141
 142         mutex_lock(&st->buf_lock);
 143         st->tx[0] = LIS3L02DQ_WRITE_REG(lower_reg_address);
 144         st->tx[1] = value & 0xFF;
 145         st->tx[2] = LIS3L02DQ_WRITE_REG(lower_reg_address + 1);
 146         st->tx[3] = (value >> 8) & 0xFF;
 147
 148         spi_message_init(&msg);
 149         spi_message_add_tail(&xfers[0], &msg);
 150         spi_message_add_tail(&xfers[1], &msg);
 151         ret = spi_sync(st->us, &msg);
 152         mutex_unlock(&st->buf_lock);
 153
 154         return ret;
 155 }
 156
 157 /**
 158  * lisl302dq_spi_read_reg_s16() - write 2 bytes to a pair of registers
 159  * @dev: device associated with child of actual device (iio_dev or iio_trig)
 160  * @reg_address: the address of the lower of the two registers. Second register
 161  *               is assumed to have address one greater.
 162  * @val: somewhere to pass back the value read
 163  **/
 164 static int lis3l02dq_spi_read_reg_s16(struct device *dev,
 165                                       u8 lower_reg_address,
 166                                       s16 *val)
 167 {
 168         struct spi_message msg;
 169         struct iio_dev *indio_dev = dev_get_drvdata(dev);
 170         struct iio_sw_ring_helper_state *h
 171                 = iio_dev_get_devdata(indio_dev);
 172         struct lis3l02dq_state *st = lis3l02dq_h_to_s(h);
 173         int ret;
 174         struct spi_transfer xfers[] = { {
 175                         .tx_buf = st->tx,
 176                         .rx_buf = st->rx,
 177                         .bits_per_word = 8,
 178                         .len = 2,
 179                         .cs_change = 1,
 180                 }, {
 181                         .tx_buf = st->tx + 2,
 182                         .rx_buf = st->rx + 2,
 183                         .bits_per_word = 8,
 184                         .len = 2,
 185                         .cs_change = 1,
 186
 187                 },
 188         };
 189
 190         mutex_lock(&st->buf_lock);
 191         st->tx[0] = LIS3L02DQ_READ_REG(lower_reg_address);
 192         st->tx[1] = 0;
 193         st->tx[2] = LIS3L02DQ_READ_REG(lower_reg_address+1);
 194         st->tx[3] = 0;
 195
 196         spi_message_init(&msg);
 197         spi_message_add_tail(&xfers[0], &msg);
 198         spi_message_add_tail(&xfers[1], &msg);
 199         ret = spi_sync(st->us, &msg);
 200         if (ret) {
 201                 dev_err(&st->us->dev, "problem when reading 16 bit register");
 202                 goto error_ret;
 203         }
 204         *val = (s16)(st->rx[1]) | ((s16)(st->rx[3]) << 8);
 205
 206 error_ret:
 207         mutex_unlock(&st->buf_lock);
 208         return ret;
 209 }
 210
 211 /**
 212  * lis3l02dq_read_signed() - attribute function used for 8 bit signed values
 213  * @dev: the child device associated with the iio_dev or iio_trigger
 214  * @attr: the attribute being processed
 215  * @buf: buffer into which put the output string
 216  **/
 217 static ssize_t lis3l02dq_read_signed(struct device *dev,
 218                                      struct device_attribute *attr,
 219                                      char *buf)
 220 {
 221         int ret;
 222         s8 val;
 223         struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
 224
 225         ret = lis3l02dq_spi_read_reg_8(dev, this_attr->address, (u8 *)&val);
 226
 227         return ret ? ret : sprintf(buf, "%d\n", val);
 228 }
 229
 230 static ssize_t lis3l02dq_read_unsigned(struct device *dev,
 231                                        struct device_attribute *attr,
 232                                        char *buf)
 233 {
 234         int ret;
 235         u8 val;
 236         struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
 237
 238         ret = lis3l02dq_spi_read_reg_8(dev, this_attr->address, &val);
 239
 240         return ret ? ret : sprintf(buf, "%d\n", val);
 241 }
 242
 243 static ssize_t lis3l02dq_write_signed(struct device *dev,
 244                                       struct device_attribute *attr,
 245                                       const char *buf,
 246                                       size_t len)
 247 {
 248         long valin;
 249         s8 val;
 250         int ret;
 251         struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
 252
 253         ret = strict_strtol(buf, 10, &valin);
 254         if (ret)
 255                 goto error_ret;
 256         val = valin;
 257         ret = lis3l02dq_spi_write_reg_8(dev, this_attr->address, (u8 *)&val);
 258
 259 error_ret:
 260         return ret ? ret : len;
 261 }
 262
 263 static ssize_t lis3l02dq_write_unsigned(struct device *dev,
 264                                         struct device_attribute *attr,
 265                                         const char *buf,
 266                                         size_t len)
 267 {
 268         int ret;
 269         ulong valin;
 270         u8 val;
 271         struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
 272
 273         ret = strict_strtoul(buf, 10, &valin);
 274         if (ret)
 275                 goto err_ret;
 276         val = valin;
 277         ret = lis3l02dq_spi_write_reg_8(dev, this_attr->address, &val);
 278
 279 err_ret:
 280         return ret ? ret : len;
 281 }
 282
 283 static ssize_t lis3l02dq_read_16bit_signed(struct device *dev,
 284                                            struct device_attribute *attr,
 285                                            char *buf)
 286 {
 287         int ret;
 288         s16 val = 0;
 289         struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
 290
 291         ret = lis3l02dq_spi_read_reg_s16(dev, this_attr->address, &val);
 292
 293         if (ret)
 294                 return ret;
 295
 296         return sprintf(buf, "%d\n", val);
 297 }
 298
 299 static ssize_t lis3l02dq_read_accel(struct device *dev,
 300                                     struct device_attribute *attr,
 301                                     char *buf)
 302 {
 303         struct iio_dev *indio_dev = dev_get_drvdata(dev);
 304         ssize_t ret;
 305
 306         /* Take the iio_dev status lock */
 307         mutex_lock(&indio_dev->mlock);
 308         if (indio_dev->currentmode == INDIO_RING_TRIGGERED)
 309                 ret = lis3l02dq_read_accel_from_ring(dev, attr, buf);
 310         else
 311                 ret =  lis3l02dq_read_16bit_signed(dev, attr, buf);
 312         mutex_unlock(&indio_dev->mlock);
 313
 314         return ret;
 315 }
 316
 317 static ssize_t lis3l02dq_write_16bit_signed(struct device *dev,
 318                                             struct device_attribute *attr,
 319                                             const char *buf,
 320                                             size_t len)
 321 {
 322         struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
 323         int ret;
 324         long val;
 325
 326         ret = strict_strtol(buf, 10, &val);
 327         if (ret)
 328                 goto error_ret;
 329         ret = lis3l02dq_spi_write_reg_s16(dev, this_attr->address, val);
 330
 331 error_ret:
 332         return ret ? ret : len;
 333 }
 334
 335 static ssize_t lis3l02dq_read_frequency(struct device *dev,
 336                                         struct device_attribute *attr,
 337                                         char *buf)
 338 {
 339         int ret, len = 0;
 340         s8 t;
 341         ret = lis3l02dq_spi_read_reg_8(dev,
 342                                        LIS3L02DQ_REG_CTRL_1_ADDR,
 343                                        (u8 *)&t);
 344         if (ret)
 345                 return ret;
 346         t &= LIS3L02DQ_DEC_MASK;
 347         switch (t) {
 348         case LIS3L02DQ_REG_CTRL_1_DF_128:
 349                 len = sprintf(buf, "280\n");
 350                 break;
 351         case LIS3L02DQ_REG_CTRL_1_DF_64:
 352                 len = sprintf(buf, "560\n");
 353                 break;
 354         case LIS3L02DQ_REG_CTRL_1_DF_32:
 355                 len = sprintf(buf, "1120\n");
 356                 break;
 357         case LIS3L02DQ_REG_CTRL_1_DF_8:
 358                 len = sprintf(buf, "4480\n");
 359                 break;
 360         }
 361         return len;
 362 }
 363
 364 static ssize_t lis3l02dq_write_frequency(struct device *dev,
 365                                          struct device_attribute *attr,
 366                                          const char *buf,
 367                                          size_t len)
 368 {
 369         struct iio_dev *indio_dev = dev_get_drvdata(dev);
 370         long val;
 371         int ret;
 372         u8 t;
 373
 374         ret = strict_strtol(buf, 10, &val);
 375         if (ret)
 376                 return ret;
 377
 378         mutex_lock(&indio_dev->mlock);
 379         ret = lis3l02dq_spi_read_reg_8(dev,
 380                                        LIS3L02DQ_REG_CTRL_1_ADDR,
 381                                        &t);
 382         if (ret)
 383                 goto error_ret_mutex;
 384         /* Wipe the bits clean */
 385         t &= ~LIS3L02DQ_DEC_MASK;
 386         switch (val) {
 387         case 280:
 388                 t |= LIS3L02DQ_REG_CTRL_1_DF_128;
 389                 break;
 390         case 560:
 391                 t |= LIS3L02DQ_REG_CTRL_1_DF_64;
 392                 break;
 393         case 1120:
 394                 t |= LIS3L02DQ_REG_CTRL_1_DF_32;
 395                 break;
 396         case 4480:
 397                 t |= LIS3L02DQ_REG_CTRL_1_DF_8;
 398                 break;
 399         default:
 400                 ret = -EINVAL;
 401                 goto error_ret_mutex;
 402         };
 403
 404         ret = lis3l02dq_spi_write_reg_8(dev,
 405                                         LIS3L02DQ_REG_CTRL_1_ADDR,
 406                                         &t);
 407
 408 error_ret_mutex:
 409         mutex_unlock(&indio_dev->mlock);
 410
 411         return ret ? ret : len;
 412 }
 413
 414 static int lis3l02dq_initial_setup(struct lis3l02dq_state *st)
 415 {
 416         int ret;
 417         u8 val, valtest;
 418
 419         st->us->mode = SPI_MODE_3;
 420
 421         spi_setup(st->us);
 422
 423         val = LIS3L02DQ_DEFAULT_CTRL1;
 424         /* Write suitable defaults to ctrl1 */
 425         ret = lis3l02dq_spi_write_reg_8(&st->help.indio_dev->dev,
 426                                         LIS3L02DQ_REG_CTRL_1_ADDR,
 427                                         &val);
 428         if (ret) {
 429                 dev_err(&st->us->dev, "problem with setup control register 1");
 430                 goto err_ret;
 431         }
 432         /* Repeat as sometimes doesn't work first time?*/
 433         ret = lis3l02dq_spi_write_reg_8(&st->help.indio_dev->dev,
 434                                         LIS3L02DQ_REG_CTRL_1_ADDR,
 435                                         &val);
 436         if (ret) {
 437                 dev_err(&st->us->dev, "problem with setup control register 1");
 438                 goto err_ret;
 439         }
 440
 441         /* Read back to check this has worked acts as loose test of correct
 442          * chip */
 443         ret = lis3l02dq_spi_read_reg_8(&st->help.indio_dev->dev,
 444                                        LIS3L02DQ_REG_CTRL_1_ADDR,
 445                                        &valtest);
 446         if (ret || (valtest != val)) {
 447                 dev_err(&st->help.indio_dev->dev, "device not playing ball");
 448                 ret = -EINVAL;
 449                 goto err_ret;
 450         }
 451
 452         val = LIS3L02DQ_DEFAULT_CTRL2;
 453         ret = lis3l02dq_spi_write_reg_8(&st->help.indio_dev->dev,
 454                                         LIS3L02DQ_REG_CTRL_2_ADDR,
 455                                         &val);
 456         if (ret) {
 457                 dev_err(&st->us->dev, "problem with setup control register 2");
 458                 goto err_ret;
 459         }
 460
 461         val = LIS3L02DQ_REG_WAKE_UP_CFG_LATCH_SRC;
 462         ret = lis3l02dq_spi_write_reg_8(&st->help.indio_dev->dev,
 463                                         LIS3L02DQ_REG_WAKE_UP_CFG_ADDR,
 464                                         &val);
 465         if (ret)
 466                 dev_err(&st->us->dev, "problem with interrupt cfg register");
 467 err_ret:
 468
 469         return ret;
 470 }
 471
 472 #define LIS3L02DQ_SIGNED_ATTR(name, reg)        \
 473         IIO_DEVICE_ATTR(name,                   \
 474                         S_IWUSR | S_IRUGO,      \
 475                         lis3l02dq_read_signed,  \
 476                         lis3l02dq_write_signed, \
 477                         reg);
 478
 479 #define LIS3L02DQ_UNSIGNED_ATTR(name, reg)              \
 480         IIO_DEVICE_ATTR(name,                           \
 481                         S_IWUSR | S_IRUGO,              \
 482                         lis3l02dq_read_unsigned,        \
 483                         lis3l02dq_write_unsigned,       \
 484                         reg);
 485
 486 static LIS3L02DQ_SIGNED_ATTR(accel_x_calibbias,
 487                              LIS3L02DQ_REG_OFFSET_X_ADDR);
 488 static LIS3L02DQ_SIGNED_ATTR(accel_y_calibbias,
 489                              LIS3L02DQ_REG_OFFSET_Y_ADDR);
 490 static LIS3L02DQ_SIGNED_ATTR(accel_z_calibbias,
 491                              LIS3L02DQ_REG_OFFSET_Z_ADDR);
 492
 493 static LIS3L02DQ_UNSIGNED_ATTR(accel_x_calibscale,
 494                                LIS3L02DQ_REG_GAIN_X_ADDR);
 495 static LIS3L02DQ_UNSIGNED_ATTR(accel_y_calibscale,
 496                                LIS3L02DQ_REG_GAIN_Y_ADDR);
 497 static LIS3L02DQ_UNSIGNED_ATTR(accel_z_calibscale,
 498                                LIS3L02DQ_REG_GAIN_Z_ADDR);
 499
 500 static IIO_DEVICE_ATTR(accel_mag_either_rising_value,
 501                        S_IWUSR | S_IRUGO,
 502                        lis3l02dq_read_16bit_signed,
 503                        lis3l02dq_write_16bit_signed,
 504                        LIS3L02DQ_REG_THS_L_ADDR);
 505 /* RFC The reading method for these will change depending on whether
 506  * ring buffer capture is in use. Is it worth making these take two
 507  * functions and let the core handle which to call, or leave as in this
 508  * driver where it is the drivers problem to manage this?
 509  */
 510
 511 static IIO_DEV_ATTR_ACCEL_X(lis3l02dq_read_accel,
 512                             LIS3L02DQ_REG_OUT_X_L_ADDR);
 513
 514 static IIO_DEV_ATTR_ACCEL_Y(lis3l02dq_read_accel,
 515                             LIS3L02DQ_REG_OUT_Y_L_ADDR);
 516
 517 static IIO_DEV_ATTR_ACCEL_Z(lis3l02dq_read_accel,
 518                             LIS3L02DQ_REG_OUT_Z_L_ADDR);
 519
 520 static IIO_DEV_ATTR_SAMP_FREQ(S_IWUSR | S_IRUGO,
 521                               lis3l02dq_read_frequency,
 522                               lis3l02dq_write_frequency);
 523
 524 static IIO_CONST_ATTR_SAMP_FREQ_AVAIL("280 560 1120 4480");
 525
 526 static ssize_t lis3l02dq_read_interrupt_config(struct device *dev,
 527                                                struct device_attribute *attr,
 528                                                char *buf)
 529 {
 530         int ret;
 531         s8 val;
 532         struct iio_event_attr *this_attr = to_iio_event_attr(attr);
 533
 534         ret = lis3l02dq_spi_read_reg_8(dev->parent,
 535                                        LIS3L02DQ_REG_WAKE_UP_CFG_ADDR,
 536                                        (u8 *)&val);
 537
 538         return ret ? ret : sprintf(buf, "%d\n", !!(val & this_attr->mask));
 539 }
 540
 541 static ssize_t lis3l02dq_write_interrupt_config(struct device *dev,
 542                                                 struct device_attribute *attr,
 543                                                 const char *buf,
 544                                                 size_t len)
 545 {
 546         struct iio_event_attr *this_attr = to_iio_event_attr(attr);
 547         struct iio_dev *indio_dev = dev_get_drvdata(dev);
 548         int ret, currentlyset, changed = 0;
 549         u8 valold, controlold;
 550         bool val;
 551
 552         val = !(buf[0] == '0');
 553
 554         mutex_lock(&indio_dev->mlock);
 555         /* read current value */
 556         ret = lis3l02dq_spi_read_reg_8(dev->parent,
 557                                        LIS3L02DQ_REG_WAKE_UP_CFG_ADDR,
 558                                        &valold);
 559         if (ret)
 560                 goto error_mutex_unlock;
 561
 562         /* read current control */
 563         ret = lis3l02dq_spi_read_reg_8(dev,
 564                                        LIS3L02DQ_REG_CTRL_2_ADDR,
 565                                        &controlold);
 566         if (ret)
 567                 goto error_mutex_unlock;
 568         currentlyset = !!(valold & this_attr->mask);
 569         if (val == false && currentlyset) {
 570                 valold &= ~this_attr->mask;
 571                 changed = 1;
 572                 iio_remove_event_from_list(this_attr->listel,
 573                                                  &indio_dev->interrupts[0]
 574                                                  ->ev_list);
 575         } else if (val == true && !currentlyset) {
 576                 changed = 1;
 577                 valold |= this_attr->mask;
 578                 iio_add_event_to_list(this_attr->listel,
 579                                             &indio_dev->interrupts[0]->ev_list);
 580         }
 581
 582         if (changed) {
 583                 ret = lis3l02dq_spi_write_reg_8(dev,
 584                                                 LIS3L02DQ_REG_WAKE_UP_CFG_ADDR,
 585                                                 &valold);
 586                 if (ret)
 587                         goto error_mutex_unlock;
 588                 /* This always enables the interrupt, even if we've remove the
 589                  * last thing using it. For this device we can use the reference
 590                  * count on the handler to tell us if anyone wants the interrupt
 591                  */
 592                 controlold = this_attr->listel->refcount ?
 593                         (controlold | LIS3L02DQ_REG_CTRL_2_ENABLE_INTERRUPT) :
 594                         (controlold & ~LIS3L02DQ_REG_CTRL_2_ENABLE_INTERRUPT);
 595                 ret = lis3l02dq_spi_write_reg_8(dev,
 596                                                 LIS3L02DQ_REG_CTRL_2_ADDR,
 597                                                 &controlold);
 598                 if (ret)
 599                         goto error_mutex_unlock;
 600         }
 601 error_mutex_unlock:
 602         mutex_unlock(&indio_dev->mlock);
 603
 604         return ret ? ret : len;
 605 }
 606
 607
 608 static int lis3l02dq_thresh_handler_th(struct iio_dev *indio_dev,
 609                                        int index,
 610                                        s64 timestamp,
 611                                        int no_test)
 612 {
 613         struct iio_sw_ring_helper_state *h
 614                 = iio_dev_get_devdata(indio_dev);
 615         struct lis3l02dq_state *st = lis3l02dq_h_to_s(h);
 616
 617         /* Stash the timestamp somewhere convenient for the bh */
 618         st->thresh_timestamp = timestamp;
 619         schedule_work(&st->work_thresh);
 620
 621         return 0;
 622 }
 623
 624
 625 /* Unforunately it appears the interrupt won't clear unless you read from the
 626  * src register.
 627  */
 628 static void lis3l02dq_thresh_handler_bh_no_check(struct work_struct *work_s)
 629 {
 630        struct lis3l02dq_state *st
 631                = container_of(work_s,
 632                        struct lis3l02dq_state, work_thresh);
 633
 634         u8 t;
 635
 636         lis3l02dq_spi_read_reg_8(&st->help.indio_dev->dev,
 637                                  LIS3L02DQ_REG_WAKE_UP_SRC_ADDR,
 638                                  &t);
 639
 640         if (t & LIS3L02DQ_REG_WAKE_UP_SRC_INTERRUPT_Z_HIGH)
 641                 iio_push_event(st->help.indio_dev, 0,
 642                                IIO_EVENT_CODE_ACCEL_Z_HIGH,
 643                                st->thresh_timestamp);
 644
 645         if (t & LIS3L02DQ_REG_WAKE_UP_SRC_INTERRUPT_Z_LOW)
 646                 iio_push_event(st->help.indio_dev, 0,
 647                                IIO_EVENT_CODE_ACCEL_Z_LOW,
 648                                st->thresh_timestamp);
 649
 650         if (t & LIS3L02DQ_REG_WAKE_UP_SRC_INTERRUPT_Y_HIGH)
 651                 iio_push_event(st->help.indio_dev, 0,
 652                                IIO_EVENT_CODE_ACCEL_Y_HIGH,
 653                                st->thresh_timestamp);
 654
 655         if (t & LIS3L02DQ_REG_WAKE_UP_SRC_INTERRUPT_Y_LOW)
 656                 iio_push_event(st->help.indio_dev, 0,
 657                                IIO_EVENT_CODE_ACCEL_Y_LOW,
 658                                st->thresh_timestamp);
 659
 660         if (t & LIS3L02DQ_REG_WAKE_UP_SRC_INTERRUPT_X_HIGH)
 661                 iio_push_event(st->help.indio_dev, 0,
 662                                IIO_EVENT_CODE_ACCEL_X_HIGH,
 663                                st->thresh_timestamp);
 664
 665         if (t & LIS3L02DQ_REG_WAKE_UP_SRC_INTERRUPT_X_LOW)
 666                 iio_push_event(st->help.indio_dev, 0,
 667                                IIO_EVENT_CODE_ACCEL_X_LOW,
 668                                st->thresh_timestamp);
 669         /* reenable the irq */
 670         enable_irq(st->us->irq);
 671         /* Ack and allow for new interrupts */
 672         lis3l02dq_spi_read_reg_8(&st->help.indio_dev->dev,
 673                                  LIS3L02DQ_REG_WAKE_UP_ACK_ADDR,
 674                                  &t);
 675
 676         return;
 677 }
 678
 679 /* A shared handler for a number of threshold types */
 680 IIO_EVENT_SH(threshold, &lis3l02dq_thresh_handler_th);
 681
 682 IIO_EVENT_ATTR_SH(accel_x_mag_pos_rising_en,
 683                   iio_event_threshold,
 684                   lis3l02dq_read_interrupt_config,
 685                   lis3l02dq_write_interrupt_config,
 686                   LIS3L02DQ_REG_WAKE_UP_CFG_INTERRUPT_X_HIGH);
 687
 688 IIO_EVENT_ATTR_SH(accel_y_mag_pos_rising_en,
 689                   iio_event_threshold,
 690                   lis3l02dq_read_interrupt_config,
 691                   lis3l02dq_write_interrupt_config,
 692                   LIS3L02DQ_REG_WAKE_UP_CFG_INTERRUPT_Y_HIGH);
 693
 694 IIO_EVENT_ATTR_SH(accel_z_mag_pos_rising_en,
 695                   iio_event_threshold,
 696                   lis3l02dq_read_interrupt_config,
 697                   lis3l02dq_write_interrupt_config,
 698                   LIS3L02DQ_REG_WAKE_UP_CFG_INTERRUPT_Z_HIGH);
 699
 700 IIO_EVENT_ATTR_SH(accel_x_mag_neg_rising_en,
 701                   iio_event_threshold,
 702                   lis3l02dq_read_interrupt_config,
 703                   lis3l02dq_write_interrupt_config,
 704                   LIS3L02DQ_REG_WAKE_UP_CFG_INTERRUPT_X_LOW);
 705
 706 IIO_EVENT_ATTR_SH(accel_y_mag_neg_rising_en,
 707                   iio_event_threshold,
 708                   lis3l02dq_read_interrupt_config,
 709                   lis3l02dq_write_interrupt_config,
 710                   LIS3L02DQ_REG_WAKE_UP_CFG_INTERRUPT_Y_LOW);
 711
 712 IIO_EVENT_ATTR_SH(accel_z_mag_neg_rising_en,
 713                   iio_event_threshold,
 714                   lis3l02dq_read_interrupt_config,
 715                   lis3l02dq_write_interrupt_config,
 716                   LIS3L02DQ_REG_WAKE_UP_CFG_INTERRUPT_Z_LOW);
 717
 718
 719 static struct attribute *lis3l02dq_event_attributes[] = {
 720         &iio_event_attr_accel_x_mag_pos_rising_en.dev_attr.attr,
 721         &iio_event_attr_accel_y_mag_pos_rising_en.dev_attr.attr,
 722         &iio_event_attr_accel_z_mag_pos_rising_en.dev_attr.attr,
 723         &iio_event_attr_accel_x_mag_neg_rising_en.dev_attr.attr,
 724         &iio_event_attr_accel_y_mag_neg_rising_en.dev_attr.attr,
 725         &iio_event_attr_accel_z_mag_neg_rising_en.dev_attr.attr,
 726         &iio_dev_attr_accel_mag_either_rising_value.dev_attr.attr,
 727         NULL
 728 };
 729
 730 static struct attribute_group lis3l02dq_event_attribute_group = {
 731         .attrs = lis3l02dq_event_attributes,
 732 };
 733
 734 static IIO_CONST_ATTR(name, "lis3l02dq");
 735 static IIO_CONST_ATTR(accel_scale, "0.00958");
 736
 737 static struct attribute *lis3l02dq_attributes[] = {
 738         &iio_dev_attr_accel_x_calibbias.dev_attr.attr,
 739         &iio_dev_attr_accel_y_calibbias.dev_attr.attr,
 740         &iio_dev_attr_accel_z_calibbias.dev_attr.attr,
 741         &iio_dev_attr_accel_x_calibscale.dev_attr.attr,
 742         &iio_dev_attr_accel_y_calibscale.dev_attr.attr,
 743         &iio_dev_attr_accel_z_calibscale.dev_attr.attr,
 744         &iio_const_attr_accel_scale.dev_attr.attr,
 745         &iio_dev_attr_accel_x_raw.dev_attr.attr,
 746         &iio_dev_attr_accel_y_raw.dev_attr.attr,
 747         &iio_dev_attr_accel_z_raw.dev_attr.attr,
 748         &iio_dev_attr_sampling_frequency.dev_attr.attr,
 749         &iio_const_attr_sampling_frequency_available.dev_attr.attr,
 750         &iio_const_attr_name.dev_attr.attr,
 751         NULL
 752 };
 753
 754 static const struct attribute_group lis3l02dq_attribute_group = {
 755         .attrs = lis3l02dq_attributes,
 756 };
 757
 758 static int __devinit lis3l02dq_probe(struct spi_device *spi)
 759 {
 760         int ret, regdone = 0;
 761         struct lis3l02dq_state *st = kzalloc(sizeof *st, GFP_KERNEL);
 762         if (!st) {
 763                 ret =  -ENOMEM;
 764                 goto error_ret;
 765         }
 766         INIT_WORK(&st->work_thresh, lis3l02dq_thresh_handler_bh_no_check);
 767         /* this is only used tor removal purposes */
 768         spi_set_drvdata(spi, st);
 769
 770         /* Allocate the comms buffers */
 771         st->rx = kzalloc(sizeof(*st->rx)*LIS3L02DQ_MAX_RX, GFP_KERNEL);
 772         if (st->rx == NULL) {
 773                 ret = -ENOMEM;
 774                 goto error_free_st;
 775         }
 776         st->tx = kzalloc(sizeof(*st->tx)*LIS3L02DQ_MAX_TX, GFP_KERNEL);
 777         if (st->tx == NULL) {
 778                 ret = -ENOMEM;
 779                 goto error_free_rx;
 780         }
 781         st->us = spi;
 782         mutex_init(&st->buf_lock);
 783         /* setup the industrialio driver allocated elements */
 784         st->help.indio_dev = iio_allocate_device();
 785         if (st->help.indio_dev == NULL) {
 786                 ret = -ENOMEM;
 787                 goto error_free_tx;
 788         }
 789
 790         st->help.indio_dev->dev.parent = &spi->dev;
 791         st->help.indio_dev->num_interrupt_lines = 1;
 792         st->help.indio_dev->event_attrs = &lis3l02dq_event_attribute_group;
 793         st->help.indio_dev->attrs = &lis3l02dq_attribute_group;
 794         st->help.indio_dev->dev_data = (void *)(&st->help);
 795         st->help.indio_dev->driver_module = THIS_MODULE;
 796         st->help.indio_dev->modes = INDIO_DIRECT_MODE;
 797
 798         ret = lis3l02dq_configure_ring(st->help.indio_dev);
 799         if (ret)
 800                 goto error_free_dev;
 801
 802         ret = iio_device_register(st->help.indio_dev);
 803         if (ret)
 804                 goto error_unreg_ring_funcs;
 805         regdone = 1;
 806
 807         ret = iio_ring_buffer_register(st->help.indio_dev->ring, 0);
 808         if (ret) {
 809                 printk(KERN_ERR "failed to initialize the ring\n");
 810                 goto error_unreg_ring_funcs;
 811         }
 812
 813         if (spi->irq && gpio_is_valid(irq_to_gpio(spi->irq)) > 0) {
 814                 st->inter = 0;
 815                 ret = iio_register_interrupt_line(spi->irq,
 816                                                   st->help.indio_dev,
 817                                                   0,
 818                                                   IRQF_TRIGGER_RISING,
 819                                                   "lis3l02dq");
 820                 if (ret)
 821                         goto error_uninitialize_ring;
 822
 823                 ret = lis3l02dq_probe_trigger(st->help.indio_dev);
 824                 if (ret)
 825                         goto error_unregister_line;
 826         }
 827
 828         /* Get the device into a sane initial state */
 829         ret = lis3l02dq_initial_setup(st);
 830         if (ret)
 831                 goto error_remove_trigger;
 832         return 0;
 833
 834 error_remove_trigger:
 835         if (st->help.indio_dev->modes & INDIO_RING_TRIGGERED)
 836                 lis3l02dq_remove_trigger(st->help.indio_dev);
 837 error_unregister_line:
 838         if (st->help.indio_dev->modes & INDIO_RING_TRIGGERED)
 839                 iio_unregister_interrupt_line(st->help.indio_dev, 0);
 840 error_uninitialize_ring:
 841         iio_ring_buffer_unregister(st->help.indio_dev->ring);
 842 error_unreg_ring_funcs:
 843         lis3l02dq_unconfigure_ring(st->help.indio_dev);
 844 error_free_dev:
 845         if (regdone)
 846                 iio_device_unregister(st->help.indio_dev);
 847         else
 848                 iio_free_device(st->help.indio_dev);
 849 error_free_tx:
 850         kfree(st->tx);
 851 error_free_rx:
 852         kfree(st->rx);
 853 error_free_st:
 854         kfree(st);
 855 error_ret:
 856         return ret;
 857 }
 858
 859 /* Power down the device */
 860 static int lis3l02dq_stop_device(struct iio_dev *indio_dev)
 861 {
 862         int ret;
 863         struct iio_sw_ring_helper_state *h
 864                 = iio_dev_get_devdata(indio_dev);
 865         struct lis3l02dq_state *st = lis3l02dq_h_to_s(h);
 866         u8 val = 0;
 867
 868         mutex_lock(&indio_dev->mlock);
 869         ret = lis3l02dq_spi_write_reg_8(&indio_dev->dev,
 870                                         LIS3L02DQ_REG_CTRL_1_ADDR,
 871                                         &val);
 872         if (ret) {
 873                 dev_err(&st->us->dev, "problem with turning device off: ctrl1");
 874                 goto err_ret;
 875         }
 876
 877         ret = lis3l02dq_spi_write_reg_8(&indio_dev->dev,
 878                                         LIS3L02DQ_REG_CTRL_2_ADDR,
 879                                         &val);
 880         if (ret)
 881                 dev_err(&st->us->dev, "problem with turning device off: ctrl2");
 882 err_ret:
 883         mutex_unlock(&indio_dev->mlock);
 884         return ret;
 885 }
 886
 887 static int lis3l02dq_remove(struct spi_device *spi)
 888 {
 889         int ret;
 890         struct lis3l02dq_state *st = spi_get_drvdata(spi);
 891         struct iio_dev *indio_dev = st->help.indio_dev;
 892
 893         ret = lis3l02dq_stop_device(indio_dev);
 894         if (ret)
 895                 goto err_ret;
 896
 897         flush_scheduled_work();
 898
 899         lis3l02dq_remove_trigger(indio_dev);
 900         if (spi->irq && gpio_is_valid(irq_to_gpio(spi->irq)) > 0)
 901                 iio_unregister_interrupt_line(indio_dev, 0);
 902
 903         iio_ring_buffer_unregister(indio_dev->ring);
 904         lis3l02dq_unconfigure_ring(indio_dev);
 905         iio_device_unregister(indio_dev);
 906         kfree(st->tx);
 907         kfree(st->rx);
 908         kfree(st);
 909
 910         return 0;
 911
 912 err_ret:
 913         return ret;
 914 }
 915
 916 static struct spi_driver lis3l02dq_driver = {
 917         .driver = {
 918                 .name = "lis3l02dq",
 919                 .owner = THIS_MODULE,
 920         },
 921         .probe = lis3l02dq_probe,
 922         .remove = __devexit_p(lis3l02dq_remove),
 923 };
 924
 925 static __init int lis3l02dq_init(void)
 926 {
 927         return spi_register_driver(&lis3l02dq_driver);
 928 }
 929 module_init(lis3l02dq_init);
 930
 931 static __exit void lis3l02dq_exit(void)
 932 {
 933         spi_unregister_driver(&lis3l02dq_driver);
 934 }
 935 module_exit(lis3l02dq_exit);
 936
 937 MODULE_AUTHOR("Jonathan Cameron <jic23@cam.ac.uk>");
 938 MODULE_DESCRIPTION("ST LIS3L02DQ Accelerometer SPI driver");
 939 MODULE_LICENSE("GPL v2");