st_magn_i2c.c 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * STMicroelectronics magnetometers driver
  4. *
  5. * Copyright 2012-2013 STMicroelectronics Inc.
  6. *
  7. * Denis Ciocca <denis.ciocca@st.com>
  8. */
  9. #include <linux/kernel.h>
  10. #include <linux/module.h>
  11. #include <linux/slab.h>
  12. #include <linux/i2c.h>
  13. #include <linux/iio/iio.h>
  14. #include <linux/iio/common/st_sensors.h>
  15. #include <linux/iio/common/st_sensors_i2c.h>
  16. #include "st_magn.h"
  17. static const struct of_device_id st_magn_of_match[] = {
  18. {
  19. .compatible = "st,lsm303dlh-magn",
  20. .data = LSM303DLH_MAGN_DEV_NAME,
  21. },
  22. {
  23. .compatible = "st,lsm303dlhc-magn",
  24. .data = LSM303DLHC_MAGN_DEV_NAME,
  25. },
  26. {
  27. .compatible = "st,lsm303dlm-magn",
  28. .data = LSM303DLM_MAGN_DEV_NAME,
  29. },
  30. {
  31. .compatible = "st,lis3mdl-magn",
  32. .data = LIS3MDL_MAGN_DEV_NAME,
  33. },
  34. {
  35. .compatible = "st,lsm303agr-magn",
  36. .data = LSM303AGR_MAGN_DEV_NAME,
  37. },
  38. {
  39. .compatible = "st,lis2mdl",
  40. .data = LIS2MDL_MAGN_DEV_NAME,
  41. },
  42. {
  43. .compatible = "st,lsm9ds1-magn",
  44. .data = LSM9DS1_MAGN_DEV_NAME,
  45. },
  46. {},
  47. };
  48. MODULE_DEVICE_TABLE(of, st_magn_of_match);
  49. static int st_magn_i2c_probe(struct i2c_client *client,
  50. const struct i2c_device_id *id)
  51. {
  52. const struct st_sensor_settings *settings;
  53. struct st_sensor_data *mdata;
  54. struct iio_dev *indio_dev;
  55. int err;
  56. st_sensors_dev_name_probe(&client->dev, client->name, sizeof(client->name));
  57. settings = st_magn_get_settings(client->name);
  58. if (!settings) {
  59. dev_err(&client->dev, "device name %s not recognized.\n",
  60. client->name);
  61. return -ENODEV;
  62. }
  63. indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*mdata));
  64. if (!indio_dev)
  65. return -ENOMEM;
  66. mdata = iio_priv(indio_dev);
  67. mdata->sensor_settings = (struct st_sensor_settings *)settings;
  68. err = st_sensors_i2c_configure(indio_dev, client);
  69. if (err < 0)
  70. return err;
  71. err = st_sensors_power_enable(indio_dev);
  72. if (err)
  73. return err;
  74. err = st_magn_common_probe(indio_dev);
  75. if (err < 0)
  76. goto st_magn_power_off;
  77. return 0;
  78. st_magn_power_off:
  79. st_sensors_power_disable(indio_dev);
  80. return err;
  81. }
  82. static int st_magn_i2c_remove(struct i2c_client *client)
  83. {
  84. struct iio_dev *indio_dev = i2c_get_clientdata(client);
  85. st_magn_common_remove(indio_dev);
  86. st_sensors_power_disable(indio_dev);
  87. return 0;
  88. }
  89. static const struct i2c_device_id st_magn_id_table[] = {
  90. { LSM303DLH_MAGN_DEV_NAME },
  91. { LSM303DLHC_MAGN_DEV_NAME },
  92. { LSM303DLM_MAGN_DEV_NAME },
  93. { LIS3MDL_MAGN_DEV_NAME },
  94. { LSM303AGR_MAGN_DEV_NAME },
  95. { LIS2MDL_MAGN_DEV_NAME },
  96. { LSM9DS1_MAGN_DEV_NAME },
  97. {},
  98. };
  99. MODULE_DEVICE_TABLE(i2c, st_magn_id_table);
  100. static struct i2c_driver st_magn_driver = {
  101. .driver = {
  102. .name = "st-magn-i2c",
  103. .of_match_table = st_magn_of_match,
  104. },
  105. .probe = st_magn_i2c_probe,
  106. .remove = st_magn_i2c_remove,
  107. .id_table = st_magn_id_table,
  108. };
  109. module_i2c_driver(st_magn_driver);
  110. MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
  111. MODULE_DESCRIPTION("STMicroelectronics magnetometers i2c driver");
  112. MODULE_LICENSE("GPL v2");