mc3230.c 4.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * mCube MC3230 3-Axis Accelerometer
  4. *
  5. * Copyright (c) 2016 Hans de Goede <[email protected]>
  6. *
  7. * IIO driver for mCube MC3230; 7-bit I2C address: 0x4c.
  8. */
  9. #include <linux/i2c.h>
  10. #include <linux/module.h>
  11. #include <linux/iio/iio.h>
  12. #include <linux/iio/sysfs.h>
  13. #define MC3230_REG_XOUT 0x00
  14. #define MC3230_REG_YOUT 0x01
  15. #define MC3230_REG_ZOUT 0x02
  16. #define MC3230_REG_MODE 0x07
  17. #define MC3230_MODE_OPCON_MASK 0x03
  18. #define MC3230_MODE_OPCON_WAKE 0x01
  19. #define MC3230_MODE_OPCON_STANDBY 0x03
  20. #define MC3230_REG_CHIP_ID 0x18
  21. #define MC3230_CHIP_ID 0x01
  22. #define MC3230_REG_PRODUCT_CODE 0x3b
  23. #define MC3230_PRODUCT_CODE 0x19
  24. /*
  25. * The accelerometer has one measurement range:
  26. *
  27. * -1.5g - +1.5g (8-bit, signed)
  28. *
  29. * scale = (1.5 + 1.5) * 9.81 / (2^8 - 1) = 0.115411765
  30. */
  31. static const int mc3230_nscale = 115411765;
  32. #define MC3230_CHANNEL(reg, axis) { \
  33. .type = IIO_ACCEL, \
  34. .address = reg, \
  35. .modified = 1, \
  36. .channel2 = IIO_MOD_##axis, \
  37. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
  38. .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \
  39. }
  40. static const struct iio_chan_spec mc3230_channels[] = {
  41. MC3230_CHANNEL(MC3230_REG_XOUT, X),
  42. MC3230_CHANNEL(MC3230_REG_YOUT, Y),
  43. MC3230_CHANNEL(MC3230_REG_ZOUT, Z),
  44. };
  45. struct mc3230_data {
  46. struct i2c_client *client;
  47. };
  48. static int mc3230_set_opcon(struct mc3230_data *data, int opcon)
  49. {
  50. int ret;
  51. struct i2c_client *client = data->client;
  52. ret = i2c_smbus_read_byte_data(client, MC3230_REG_MODE);
  53. if (ret < 0) {
  54. dev_err(&client->dev, "failed to read mode reg: %d\n", ret);
  55. return ret;
  56. }
  57. ret &= ~MC3230_MODE_OPCON_MASK;
  58. ret |= opcon;
  59. ret = i2c_smbus_write_byte_data(client, MC3230_REG_MODE, ret);
  60. if (ret < 0) {
  61. dev_err(&client->dev, "failed to write mode reg: %d\n", ret);
  62. return ret;
  63. }
  64. return 0;
  65. }
  66. static int mc3230_read_raw(struct iio_dev *indio_dev,
  67. struct iio_chan_spec const *chan,
  68. int *val, int *val2, long mask)
  69. {
  70. struct mc3230_data *data = iio_priv(indio_dev);
  71. int ret;
  72. switch (mask) {
  73. case IIO_CHAN_INFO_RAW:
  74. ret = i2c_smbus_read_byte_data(data->client, chan->address);
  75. if (ret < 0)
  76. return ret;
  77. *val = sign_extend32(ret, 7);
  78. return IIO_VAL_INT;
  79. case IIO_CHAN_INFO_SCALE:
  80. *val = 0;
  81. *val2 = mc3230_nscale;
  82. return IIO_VAL_INT_PLUS_NANO;
  83. default:
  84. return -EINVAL;
  85. }
  86. }
  87. static const struct iio_info mc3230_info = {
  88. .read_raw = mc3230_read_raw,
  89. };
  90. static int mc3230_probe(struct i2c_client *client,
  91. const struct i2c_device_id *id)
  92. {
  93. int ret;
  94. struct iio_dev *indio_dev;
  95. struct mc3230_data *data;
  96. /* First check chip-id and product-id */
  97. ret = i2c_smbus_read_byte_data(client, MC3230_REG_CHIP_ID);
  98. if (ret != MC3230_CHIP_ID)
  99. return (ret < 0) ? ret : -ENODEV;
  100. ret = i2c_smbus_read_byte_data(client, MC3230_REG_PRODUCT_CODE);
  101. if (ret != MC3230_PRODUCT_CODE)
  102. return (ret < 0) ? ret : -ENODEV;
  103. indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
  104. if (!indio_dev) {
  105. dev_err(&client->dev, "iio allocation failed!\n");
  106. return -ENOMEM;
  107. }
  108. data = iio_priv(indio_dev);
  109. data->client = client;
  110. i2c_set_clientdata(client, indio_dev);
  111. indio_dev->info = &mc3230_info;
  112. indio_dev->name = "mc3230";
  113. indio_dev->modes = INDIO_DIRECT_MODE;
  114. indio_dev->channels = mc3230_channels;
  115. indio_dev->num_channels = ARRAY_SIZE(mc3230_channels);
  116. ret = mc3230_set_opcon(data, MC3230_MODE_OPCON_WAKE);
  117. if (ret < 0)
  118. return ret;
  119. ret = iio_device_register(indio_dev);
  120. if (ret < 0) {
  121. dev_err(&client->dev, "device_register failed\n");
  122. mc3230_set_opcon(data, MC3230_MODE_OPCON_STANDBY);
  123. }
  124. return ret;
  125. }
  126. static void mc3230_remove(struct i2c_client *client)
  127. {
  128. struct iio_dev *indio_dev = i2c_get_clientdata(client);
  129. iio_device_unregister(indio_dev);
  130. mc3230_set_opcon(iio_priv(indio_dev), MC3230_MODE_OPCON_STANDBY);
  131. }
  132. static int mc3230_suspend(struct device *dev)
  133. {
  134. struct mc3230_data *data;
  135. data = iio_priv(i2c_get_clientdata(to_i2c_client(dev)));
  136. return mc3230_set_opcon(data, MC3230_MODE_OPCON_STANDBY);
  137. }
  138. static int mc3230_resume(struct device *dev)
  139. {
  140. struct mc3230_data *data;
  141. data = iio_priv(i2c_get_clientdata(to_i2c_client(dev)));
  142. return mc3230_set_opcon(data, MC3230_MODE_OPCON_WAKE);
  143. }
  144. static DEFINE_SIMPLE_DEV_PM_OPS(mc3230_pm_ops, mc3230_suspend, mc3230_resume);
  145. static const struct i2c_device_id mc3230_i2c_id[] = {
  146. {"mc3230", 0},
  147. {}
  148. };
  149. MODULE_DEVICE_TABLE(i2c, mc3230_i2c_id);
  150. static struct i2c_driver mc3230_driver = {
  151. .driver = {
  152. .name = "mc3230",
  153. .pm = pm_sleep_ptr(&mc3230_pm_ops),
  154. },
  155. .probe = mc3230_probe,
  156. .remove = mc3230_remove,
  157. .id_table = mc3230_i2c_id,
  158. };
  159. module_i2c_driver(mc3230_driver);
  160. MODULE_AUTHOR("Hans de Goede <[email protected]>");
  161. MODULE_DESCRIPTION("mCube MC3230 3-Axis Accelerometer driver");
  162. MODULE_LICENSE("GPL v2");