drivers/iio/accel/da311.c

   1 /**
   2  * IIO driver for the MiraMEMS DA311 3-axis accelerometer
   3  *
   4  * Copyright (c) 2016 Hans de Goede <hdegoede@redhat.com>
   5  * Copyright (c) 2011-2013 MiraMEMS Sensing Technology Co., Ltd.
   6  *
   7  * This program is free software; you can redistribute it and/or modify it
   8  * under the terms and conditions of the GNU General Public License,
   9  * version 2, as published by the Free Software Foundation.
  10  */
  11
  12 #include <linux/module.h>
  13 #include <linux/i2c.h>
  14 #include <linux/iio/iio.h>
  15 #include <linux/iio/sysfs.h>
  16 #include <linux/byteorder/generic.h>
  17
  18 #define DA311_CHIP_ID                   0x13
  19
  20 /*
  21  * Note register addressed go from 0 - 0x3f and then wrap.
  22  * For some reason there are 2 banks with 0 - 0x3f addresses,
  23  * rather then a single 0-0x7f bank.
  24  */
  25
  26 /* Bank 0 regs */
  27 #define DA311_REG_BANK                  0x0000
  28 #define DA311_REG_LDO_REG               0x0006
  29 #define DA311_REG_CHIP_ID               0x000f
  30 #define DA311_REG_TEMP_CFG_REG          0x001f
  31 #define DA311_REG_CTRL_REG1             0x0020
  32 #define DA311_REG_CTRL_REG3             0x0022
  33 #define DA311_REG_CTRL_REG4             0x0023
  34 #define DA311_REG_CTRL_REG5             0x0024
  35 #define DA311_REG_CTRL_REG6             0x0025
  36 #define DA311_REG_STATUS_REG            0x0027
  37 #define DA311_REG_OUT_X_L               0x0028
  38 #define DA311_REG_OUT_X_H               0x0029
  39 #define DA311_REG_OUT_Y_L               0x002a
  40 #define DA311_REG_OUT_Y_H               0x002b
  41 #define DA311_REG_OUT_Z_L               0x002c
  42 #define DA311_REG_OUT_Z_H               0x002d
  43 #define DA311_REG_INT1_CFG              0x0030
  44 #define DA311_REG_INT1_SRC              0x0031
  45 #define DA311_REG_INT1_THS              0x0032
  46 #define DA311_REG_INT1_DURATION         0x0033
  47 #define DA311_REG_INT2_CFG              0x0034
  48 #define DA311_REG_INT2_SRC              0x0035
  49 #define DA311_REG_INT2_THS              0x0036
  50 #define DA311_REG_INT2_DURATION         0x0037
  51 #define DA311_REG_CLICK_CFG             0x0038
  52 #define DA311_REG_CLICK_SRC             0x0039
  53 #define DA311_REG_CLICK_THS             0x003a
  54 #define DA311_REG_TIME_LIMIT            0x003b
  55 #define DA311_REG_TIME_LATENCY          0x003c
  56 #define DA311_REG_TIME_WINDOW           0x003d
  57
  58 /* Bank 1 regs */
  59 #define DA311_REG_SOFT_RESET            0x0105
  60 #define DA311_REG_OTP_XOFF_L            0x0110
  61 #define DA311_REG_OTP_XOFF_H            0x0111
  62 #define DA311_REG_OTP_YOFF_L            0x0112
  63 #define DA311_REG_OTP_YOFF_H            0x0113
  64 #define DA311_REG_OTP_ZOFF_L            0x0114
  65 #define DA311_REG_OTP_ZOFF_H            0x0115
  66 #define DA311_REG_OTP_XSO               0x0116
  67 #define DA311_REG_OTP_YSO               0x0117
  68 #define DA311_REG_OTP_ZSO               0x0118
  69 #define DA311_REG_OTP_TRIM_OSC          0x011b
  70 #define DA311_REG_LPF_ABSOLUTE          0x011c
  71 #define DA311_REG_TEMP_OFF1             0x0127
  72 #define DA311_REG_TEMP_OFF2             0x0128
  73 #define DA311_REG_TEMP_OFF3             0x0129
  74 #define DA311_REG_OTP_TRIM_THERM_H      0x011a
  75
  76 /*
  77  * a value of + or -1024 corresponds to + or - 1G
  78  * scale = 9.81 / 1024 = 0.009580078
  79  */
  80
  81 static const int da311_nscale = 9580078;
  82
  83 #define DA311_CHANNEL(reg, axis) {      \
  84         .type = IIO_ACCEL,      \
  85         .address = reg, \
  86         .modified = 1,  \
  87         .channel2 = IIO_MOD_##axis,     \
  88         .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),   \
  89         .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE),   \
  90 }
  91
  92 static const struct iio_chan_spec da311_channels[] = {
  93         /* | 0x80 comes from the android driver */
  94         DA311_CHANNEL(DA311_REG_OUT_X_L | 0x80, X),
  95         DA311_CHANNEL(DA311_REG_OUT_Y_L | 0x80, Y),
  96         DA311_CHANNEL(DA311_REG_OUT_Z_L | 0x80, Z),
  97 };
  98
  99 struct da311_data {
 100         struct i2c_client *client;
 101 };
 102
 103 static int da311_register_mask_write(struct i2c_client *client, u16 addr,
 104                                      u8 mask, u8 data)
 105 {
 106         int ret;
 107         u8 tmp_data = 0;
 108
 109         if (addr & 0xff00) {
 110                 /* Select bank 1 */
 111                 ret = i2c_smbus_write_byte_data(client, DA311_REG_BANK, 0x01);
 112                 if (ret < 0)
 113                         return ret;
 114         }
 115
 116         if (mask != 0xff) {
 117                 ret = i2c_smbus_read_byte_data(client, addr);
 118                 if (ret < 0)
 119                         return ret;
 120                 tmp_data = ret;
 121         }
 122
 123         tmp_data &= ~mask;
 124         tmp_data |= data & mask;
 125         ret = i2c_smbus_write_byte_data(client, addr & 0xff, tmp_data);
 126         if (ret < 0)
 127                 return ret;
 128
 129         if (addr & 0xff00) {
 130                 /* Back to bank 0 */
 131                 ret = i2c_smbus_write_byte_data(client, DA311_REG_BANK, 0x00);
 132                 if (ret < 0)
 133                         return ret;
 134         }
 135
 136         return 0;
 137 }
 138
 139 /* Init sequence taken from the android driver */
 140 static int da311_reset(struct i2c_client *client)
 141 {
 142         static const struct {
 143                 u16 addr;
 144                 u8 mask;
 145                 u8 data;
 146         } init_data[] = {
 147                 { DA311_REG_TEMP_CFG_REG,       0xff,   0x08 },
 148                 { DA311_REG_CTRL_REG5,          0xff,   0x80 },
 149                 { DA311_REG_CTRL_REG4,          0x30,   0x00 },
 150                 { DA311_REG_CTRL_REG1,          0xff,   0x6f },
 151                 { DA311_REG_TEMP_CFG_REG,       0xff,   0x88 },
 152                 { DA311_REG_LDO_REG,            0xff,   0x02 },
 153                 { DA311_REG_OTP_TRIM_OSC,       0xff,   0x27 },
 154                 { DA311_REG_LPF_ABSOLUTE,       0xff,   0x30 },
 155                 { DA311_REG_TEMP_OFF1,          0xff,   0x3f },
 156                 { DA311_REG_TEMP_OFF2,          0xff,   0xff },
 157                 { DA311_REG_TEMP_OFF3,          0xff,   0x0f },
 158         };
 159         int i, ret;
 160
 161         /* Reset */
 162         ret = da311_register_mask_write(client, DA311_REG_SOFT_RESET,
 163                                         0xff, 0xaa);
 164         if (ret < 0)
 165                 return ret;
 166
 167         for (i = 0; i < ARRAY_SIZE(init_data); i++) {
 168                 ret = da311_register_mask_write(client,
 169                                                 init_data[i].addr,
 170                                                 init_data[i].mask,
 171                                                 init_data[i].data);
 172                 if (ret < 0)
 173                         return ret;
 174         }
 175
 176         return 0;
 177 }
 178
 179 static int da311_enable(struct i2c_client *client, bool enable)
 180 {
 181         u8 data = enable ? 0x00 : 0x20;
 182
 183         return da311_register_mask_write(client, DA311_REG_TEMP_CFG_REG,
 184                                          0x20, data);
 185 }
 186
 187 static int da311_read_raw(struct iio_dev *indio_dev,
 188                                 struct iio_chan_spec const *chan,
 189                                 int *val, int *val2, long mask)
 190 {
 191         struct da311_data *data = iio_priv(indio_dev);
 192         int ret;
 193
 194         switch (mask) {
 195         case IIO_CHAN_INFO_RAW:
 196                 ret = i2c_smbus_read_word_data(data->client, chan->address);
 197                 if (ret < 0)
 198                         return ret;
 199                 /*
 200                  * Values are 12 bits, stored as 16 bits with the 4
 201                  * least significant bits always 0.
 202                  */
 203                 *val = (short)ret >> 4;
 204                 return IIO_VAL_INT;
 205         case IIO_CHAN_INFO_SCALE:
 206                 *val = 0;
 207                 *val2 = da311_nscale;
 208                 return IIO_VAL_INT_PLUS_NANO;
 209         default:
 210                 return -EINVAL;
 211         }
 212 }
 213
 214 static const struct iio_info da311_info = {
 215         .driver_module  = THIS_MODULE,
 216         .read_raw       = da311_read_raw,
 217 };
 218
 219 static int da311_probe(struct i2c_client *client,
 220                         const struct i2c_device_id *id)
 221 {
 222         int ret;
 223         struct iio_dev *indio_dev;
 224         struct da311_data *data;
 225
 226         ret = i2c_smbus_read_byte_data(client, DA311_REG_CHIP_ID);
 227         if (ret != DA311_CHIP_ID)
 228                 return (ret < 0) ? ret : -ENODEV;
 229
 230         indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
 231         if (!indio_dev)
 232                 return -ENOMEM;
 233
 234         data = iio_priv(indio_dev);
 235         data->client = client;
 236         i2c_set_clientdata(client, indio_dev);
 237
 238         indio_dev->dev.parent = &client->dev;
 239         indio_dev->info = &da311_info;
 240         indio_dev->name = "da311";
 241         indio_dev->modes = INDIO_DIRECT_MODE;
 242         indio_dev->channels = da311_channels;
 243         indio_dev->num_channels = ARRAY_SIZE(da311_channels);
 244
 245         ret = da311_reset(client);
 246         if (ret < 0)
 247                 return ret;
 248
 249         ret = da311_enable(client, true);
 250         if (ret < 0)
 251                 return ret;
 252
 253         ret = iio_device_register(indio_dev);
 254         if (ret < 0) {
 255                 dev_err(&client->dev, "device_register failed\n");
 256                 da311_enable(client, false);
 257         }
 258
 259         return ret;
 260 }
 261
 262 static int da311_remove(struct i2c_client *client)
 263 {
 264         struct iio_dev *indio_dev = i2c_get_clientdata(client);
 265
 266         iio_device_unregister(indio_dev);
 267
 268         return da311_enable(client, false);
 269 }
 270
 271 #ifdef CONFIG_PM_SLEEP
 272 static int da311_suspend(struct device *dev)
 273 {
 274         return da311_enable(to_i2c_client(dev), false);
 275 }
 276
 277 static int da311_resume(struct device *dev)
 278 {
 279         return da311_enable(to_i2c_client(dev), true);
 280 }
 281 #endif
 282
 283 static SIMPLE_DEV_PM_OPS(da311_pm_ops, da311_suspend, da311_resume);
 284
 285 static const struct i2c_device_id da311_i2c_id[] = {
 286         {"da311", 0},
 287         {}
 288 };
 289 MODULE_DEVICE_TABLE(i2c, da311_i2c_id);
 290
 291 static struct i2c_driver da311_driver = {
 292         .driver = {
 293                 .name = "da311",
 294                 .pm = &da311_pm_ops,
 295         },
 296         .probe          = da311_probe,
 297         .remove         = da311_remove,
 298         .id_table       = da311_i2c_id,
 299 };
 300
 301 module_i2c_driver(da311_driver);
 302
 303 MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
 304 MODULE_DESCRIPTION("MiraMEMS DA311 3-Axis Accelerometer driver");
 305 MODULE_LICENSE("GPL v2");