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