1 /* 2 * MXC6255 - MEMSIC orientation sensing accelerometer 3 * 4 * Copyright (c) 2015, Intel Corporation. 5 * 6 * This file is subject to the terms and conditions of version 2 of 7 * the GNU General Public License. See the file COPYING in the main 8 * directory of this archive for more details. 9 * 10 * IIO driver for MXC6255 (7-bit I2C slave address 0x15). 11 */ 12 13 #include <linux/module.h> 14 #include <linux/i2c.h> 15 #include <linux/init.h> 16 #include <linux/iio/iio.h> 17 #include <linux/delay.h> 18 #include <linux/acpi.h> 19 #include <linux/regmap.h> 20 #include <linux/iio/sysfs.h> 21 22 #define MXC6255_DRV_NAME "mxc6255" 23 #define MXC6255_REGMAP_NAME "mxc6255_regmap" 24 25 #define MXC6255_REG_XOUT 0x00 26 #define MXC6255_REG_YOUT 0x01 27 #define MXC6255_REG_CHIP_ID 0x08 28 29 #define MXC6255_CHIP_ID 0x05 30 31 /* 32 * MXC6255 has only one measurement range: +/- 2G. 33 * The acceleration output is an 8-bit value. 34 * 35 * Scale is calculated as follows: 36 * (2 + 2) * 9.80665 / (2^8 - 1) = 0.153829 37 * 38 * Scale value for +/- 2G measurement range 39 */ 40 #define MXC6255_SCALE 153829 41 42 enum mxc6255_axis { 43 AXIS_X, 44 AXIS_Y, 45 }; 46 47 struct mxc6255_data { 48 struct i2c_client *client; 49 struct regmap *regmap; 50 }; 51 52 static int mxc6255_read_raw(struct iio_dev *indio_dev, 53 struct iio_chan_spec const *chan, 54 int *val, int *val2, long mask) 55 { 56 struct mxc6255_data *data = iio_priv(indio_dev); 57 unsigned int reg; 58 int ret; 59 60 switch (mask) { 61 case IIO_CHAN_INFO_RAW: 62 ret = regmap_read(data->regmap, chan->address, ®); 63 if (ret < 0) { 64 dev_err(&data->client->dev, 65 "Error reading reg %lu\n", chan->address); 66 return ret; 67 } 68 69 *val = sign_extend32(reg, 7); 70 return IIO_VAL_INT; 71 case IIO_CHAN_INFO_SCALE: 72 *val = 0; 73 *val2 = MXC6255_SCALE; 74 return IIO_VAL_INT_PLUS_MICRO; 75 default: 76 return -EINVAL; 77 } 78 } 79 80 static const struct iio_info mxc6255_info = { 81 .read_raw = mxc6255_read_raw, 82 }; 83 84 #define MXC6255_CHANNEL(_axis, reg) { \ 85 .type = IIO_ACCEL, \ 86 .modified = 1, \ 87 .channel2 = IIO_MOD_##_axis, \ 88 .address = reg, \ 89 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \ 90 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \ 91 } 92 93 static const struct iio_chan_spec mxc6255_channels[] = { 94 MXC6255_CHANNEL(X, MXC6255_REG_XOUT), 95 MXC6255_CHANNEL(Y, MXC6255_REG_YOUT), 96 }; 97 98 static bool mxc6255_is_readable_reg(struct device *dev, unsigned int reg) 99 { 100 switch (reg) { 101 case MXC6255_REG_XOUT: 102 case MXC6255_REG_YOUT: 103 case MXC6255_REG_CHIP_ID: 104 return true; 105 default: 106 return false; 107 } 108 } 109 110 static const struct regmap_config mxc6255_regmap_config = { 111 .name = MXC6255_REGMAP_NAME, 112 113 .reg_bits = 8, 114 .val_bits = 8, 115 116 .readable_reg = mxc6255_is_readable_reg, 117 }; 118 119 static int mxc6255_probe(struct i2c_client *client, 120 const struct i2c_device_id *id) 121 { 122 struct mxc6255_data *data; 123 struct iio_dev *indio_dev; 124 struct regmap *regmap; 125 unsigned int chip_id; 126 int ret; 127 128 indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 129 if (!indio_dev) 130 return -ENOMEM; 131 132 regmap = devm_regmap_init_i2c(client, &mxc6255_regmap_config); 133 if (IS_ERR(regmap)) { 134 dev_err(&client->dev, "Error initializing regmap\n"); 135 return PTR_ERR(regmap); 136 } 137 138 data = iio_priv(indio_dev); 139 i2c_set_clientdata(client, indio_dev); 140 data->client = client; 141 data->regmap = regmap; 142 143 indio_dev->name = MXC6255_DRV_NAME; 144 indio_dev->dev.parent = &client->dev; 145 indio_dev->channels = mxc6255_channels; 146 indio_dev->num_channels = ARRAY_SIZE(mxc6255_channels); 147 indio_dev->modes = INDIO_DIRECT_MODE; 148 indio_dev->info = &mxc6255_info; 149 150 ret = regmap_read(data->regmap, MXC6255_REG_CHIP_ID, &chip_id); 151 if (ret < 0) { 152 dev_err(&client->dev, "Error reading chip id %d\n", ret); 153 return ret; 154 } 155 156 if ((chip_id & 0x1f) != MXC6255_CHIP_ID) { 157 dev_err(&client->dev, "Invalid chip id %x\n", chip_id); 158 return -ENODEV; 159 } 160 161 dev_dbg(&client->dev, "Chip id %x\n", chip_id); 162 163 ret = devm_iio_device_register(&client->dev, indio_dev); 164 if (ret < 0) { 165 dev_err(&client->dev, "Could not register IIO device\n"); 166 return ret; 167 } 168 169 return 0; 170 } 171 172 static const struct acpi_device_id mxc6255_acpi_match[] = { 173 {"MXC6225", 0}, 174 {"MXC6255", 0}, 175 { } 176 }; 177 MODULE_DEVICE_TABLE(acpi, mxc6255_acpi_match); 178 179 static const struct i2c_device_id mxc6255_id[] = { 180 {"mxc6225", 0}, 181 {"mxc6255", 0}, 182 { } 183 }; 184 MODULE_DEVICE_TABLE(i2c, mxc6255_id); 185 186 static struct i2c_driver mxc6255_driver = { 187 .driver = { 188 .name = MXC6255_DRV_NAME, 189 .acpi_match_table = ACPI_PTR(mxc6255_acpi_match), 190 }, 191 .probe = mxc6255_probe, 192 .id_table = mxc6255_id, 193 }; 194 195 module_i2c_driver(mxc6255_driver); 196 197 MODULE_AUTHOR("Teodora Baluta <teodora.baluta@intel.com>"); 198 MODULE_DESCRIPTION("MEMSIC MXC6255 orientation sensing accelerometer driver"); 199 MODULE_LICENSE("GPL v2"); 200