drivers/staging/iio/gyro/adis16130_core.c

   1 /*
   2  * ADIS16130 Digital Output, High Precision Angular Rate Sensor driver
   3  *
   4  * Copyright 2010 Analog Devices Inc.
   5  *
   6  * Licensed under the GPL-2 or later.
   7  */
   8
   9 #include <linux/delay.h>
  10 #include <linux/mutex.h>
  11 #include <linux/device.h>
  12 #include <linux/kernel.h>
  13 #include <linux/spi/spi.h>
  14 #include <linux/slab.h>
  15 #include <linux/sysfs.h>
  16 #include <linux/list.h>
  17 #include <linux/module.h>
  18
  19 #include <linux/iio/iio.h>
  20 #include <linux/iio/sysfs.h>
  21
  22 #define ADIS16130_CON         0x0
  23 #define ADIS16130_CON_RD      (1 << 6)
  24 #define ADIS16130_IOP         0x1
  25
  26 /* 1 = data-ready signal low when unread data on all channels; */
  27 #define ADIS16130_IOP_ALL_RDY (1 << 3)
  28 #define ADIS16130_IOP_SYNC    (1 << 0) /* 1 = synchronization enabled */
  29 #define ADIS16130_RATEDATA    0x8 /* Gyroscope output, rate of rotation */
  30 #define ADIS16130_TEMPDATA    0xA /* Temperature output */
  31 #define ADIS16130_RATECS      0x28 /* Gyroscope channel setup */
  32 #define ADIS16130_RATECS_EN   (1 << 3) /* 1 = channel enable; */
  33 #define ADIS16130_TEMPCS      0x2A /* Temperature channel setup */
  34 #define ADIS16130_TEMPCS_EN   (1 << 3)
  35 #define ADIS16130_RATECONV    0x30
  36 #define ADIS16130_TEMPCONV    0x32
  37 #define ADIS16130_MODE        0x38
  38 #define ADIS16130_MODE_24BIT  (1 << 1) /* 1 = 24-bit resolution; */
  39
  40 /**
  41  * struct adis16130_state - device instance specific data
  42  * @us:                 actual spi_device to write data
  43  * @buf_lock:           mutex to protect tx and rx
  44  * @buf:                unified tx/rx buffer
  45  **/
  46 struct adis16130_state {
  47         struct spi_device               *us;
  48         struct mutex                    buf_lock;
  49         u8                              buf[4] ____cacheline_aligned;
  50 };
  51
  52 static int adis16130_spi_read(struct iio_dev *indio_dev, u8 reg_addr, u32 *val)
  53 {
  54         int ret;
  55         struct adis16130_state *st = iio_priv(indio_dev);
  56         struct spi_message msg;
  57         struct spi_transfer xfer = {
  58                 .tx_buf = st->buf,
  59                 .rx_buf = st->buf,
  60                 .len = 4,
  61         };
  62
  63         mutex_lock(&st->buf_lock);
  64
  65         st->buf[0] = ADIS16130_CON_RD | reg_addr;
  66         st->buf[1] = st->buf[2] = st->buf[3] = 0;
  67
  68         spi_message_init(&msg);
  69         spi_message_add_tail(&xfer, &msg);
  70         ret = spi_sync(st->us, &msg);
  71         ret = spi_read(st->us, st->buf, 4);
  72
  73         if (ret == 0)
  74                 *val = (st->buf[1] << 16) | (st->buf[2] << 8) | st->buf[3];
  75         mutex_unlock(&st->buf_lock);
  76
  77         return ret;
  78 }
  79
  80 static int adis16130_read_raw(struct iio_dev *indio_dev,
  81                               struct iio_chan_spec const *chan,
  82                               int *val, int *val2,
  83                               long mask)
  84 {
  85         int ret;
  86         u32 temp;
  87
  88         /* Take the iio_dev status lock */
  89         mutex_lock(&indio_dev->mlock);
  90         ret =  adis16130_spi_read(indio_dev, chan->address, &temp);
  91         mutex_unlock(&indio_dev->mlock);
  92         if (ret)
  93                 return ret;
  94         *val = temp;
  95         return IIO_VAL_INT;
  96 }
  97
  98 static const struct iio_chan_spec adis16130_channels[] = {
  99         {
 100                 .type = IIO_ANGL_VEL,
 101                 .modified = 1,
 102                 .channel2 = IIO_MOD_Z,
 103                 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
 104                 .address = ADIS16130_RATEDATA,
 105         }, {
 106                 .type = IIO_TEMP,
 107                 .indexed = 1,
 108                 .channel = 0,
 109                 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
 110                 .address = ADIS16130_TEMPDATA,
 111         }
 112 };
 113
 114 static const struct iio_info adis16130_info = {
 115         .read_raw = &adis16130_read_raw,
 116         .driver_module = THIS_MODULE,
 117 };
 118
 119 static int adis16130_probe(struct spi_device *spi)
 120 {
 121         int ret;
 122         struct adis16130_state *st;
 123         struct iio_dev *indio_dev;
 124
 125         /* setup the industrialio driver allocated elements */
 126         indio_dev = iio_device_alloc(sizeof(*st));
 127         if (indio_dev == NULL) {
 128                 ret = -ENOMEM;
 129                 goto error_ret;
 130         }
 131         st = iio_priv(indio_dev);
 132         /* this is only used for removal purposes */
 133         spi_set_drvdata(spi, indio_dev);
 134         st->us = spi;
 135         mutex_init(&st->buf_lock);
 136         indio_dev->name = spi->dev.driver->name;
 137         indio_dev->channels = adis16130_channels;
 138         indio_dev->num_channels = ARRAY_SIZE(adis16130_channels);
 139         indio_dev->dev.parent = &spi->dev;
 140         indio_dev->info = &adis16130_info;
 141         indio_dev->modes = INDIO_DIRECT_MODE;
 142
 143         ret = iio_device_register(indio_dev);
 144         if (ret)
 145                 goto error_free_dev;
 146
 147         return 0;
 148
 149 error_free_dev:
 150         iio_device_free(indio_dev);
 151
 152 error_ret:
 153         return ret;
 154 }
 155
 156 /* fixme, confirm ordering in this function */
 157 static int adis16130_remove(struct spi_device *spi)
 158 {
 159         iio_device_unregister(spi_get_drvdata(spi));
 160         iio_device_free(spi_get_drvdata(spi));
 161
 162         return 0;
 163 }
 164
 165 static struct spi_driver adis16130_driver = {
 166         .driver = {
 167                 .name = "adis16130",
 168                 .owner = THIS_MODULE,
 169         },
 170         .probe = adis16130_probe,
 171         .remove = adis16130_remove,
 172 };
 173 module_spi_driver(adis16130_driver);
 174
 175 MODULE_AUTHOR("Barry Song <21cnbao@gmail.com>");
 176 MODULE_DESCRIPTION("Analog Devices ADIS16130 High Precision Angular Rate");
 177 MODULE_LICENSE("GPL v2");
 178 MODULE_ALIAS("spi:adis16130");