1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * STMicroelectronics accelerometers 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/mod_devicetable.h> 13 #include <linux/spi/spi.h> 14 #include <linux/iio/iio.h> 15 16 #include <linux/iio/common/st_sensors.h> 17 #include <linux/iio/common/st_sensors_spi.h> 18 #include "st_accel.h" 19 20 /* 21 * For new single-chip sensors use <device_name> as compatible string. 22 * For old single-chip devices keep <device_name>-accel to maintain 23 * compatibility 24 */ 25 static const struct of_device_id st_accel_of_match[] = { 26 { 27 /* An older compatible */ 28 .compatible = "st,lis302dl-spi", 29 .data = LIS3LV02DL_ACCEL_DEV_NAME, 30 }, 31 { 32 .compatible = "st,lis3lv02dl-accel", 33 .data = LIS3LV02DL_ACCEL_DEV_NAME, 34 }, 35 { 36 .compatible = "st,lis3dh-accel", 37 .data = LIS3DH_ACCEL_DEV_NAME, 38 }, 39 { 40 .compatible = "st,lsm330d-accel", 41 .data = LSM330D_ACCEL_DEV_NAME, 42 }, 43 { 44 .compatible = "st,lsm330dl-accel", 45 .data = LSM330DL_ACCEL_DEV_NAME, 46 }, 47 { 48 .compatible = "st,lsm330dlc-accel", 49 .data = LSM330DLC_ACCEL_DEV_NAME, 50 }, 51 { 52 .compatible = "st,lis331dlh-accel", 53 .data = LIS331DLH_ACCEL_DEV_NAME, 54 }, 55 { 56 .compatible = "st,lsm330-accel", 57 .data = LSM330_ACCEL_DEV_NAME, 58 }, 59 { 60 .compatible = "st,lsm303agr-accel", 61 .data = LSM303AGR_ACCEL_DEV_NAME, 62 }, 63 { 64 .compatible = "st,lis2dh12-accel", 65 .data = LIS2DH12_ACCEL_DEV_NAME, 66 }, 67 { 68 .compatible = "st,lis3l02dq", 69 .data = LIS3L02DQ_ACCEL_DEV_NAME, 70 }, 71 { 72 .compatible = "st,lng2dm-accel", 73 .data = LNG2DM_ACCEL_DEV_NAME, 74 }, 75 { 76 .compatible = "st,h3lis331dl-accel", 77 .data = H3LIS331DL_ACCEL_DEV_NAME, 78 }, 79 { 80 .compatible = "st,lis331dl-accel", 81 .data = LIS331DL_ACCEL_DEV_NAME, 82 }, 83 { 84 .compatible = "st,lis2dw12", 85 .data = LIS2DW12_ACCEL_DEV_NAME, 86 }, 87 { 88 .compatible = "st,lis3dhh", 89 .data = LIS3DHH_ACCEL_DEV_NAME, 90 }, 91 { 92 .compatible = "st,lis3de", 93 .data = LIS3DE_ACCEL_DEV_NAME, 94 }, 95 {} 96 }; 97 MODULE_DEVICE_TABLE(of, st_accel_of_match); 98 99 static int st_accel_spi_probe(struct spi_device *spi) 100 { 101 const struct st_sensor_settings *settings; 102 struct st_sensor_data *adata; 103 struct iio_dev *indio_dev; 104 int err; 105 106 st_sensors_dev_name_probe(&spi->dev, spi->modalias, sizeof(spi->modalias)); 107 108 settings = st_accel_get_settings(spi->modalias); 109 if (!settings) { 110 dev_err(&spi->dev, "device name %s not recognized.\n", 111 spi->modalias); 112 return -ENODEV; 113 } 114 115 indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*adata)); 116 if (!indio_dev) 117 return -ENOMEM; 118 119 adata = iio_priv(indio_dev); 120 adata->sensor_settings = (struct st_sensor_settings *)settings; 121 122 err = st_sensors_spi_configure(indio_dev, spi); 123 if (err < 0) 124 return err; 125 126 err = st_sensors_power_enable(indio_dev); 127 if (err) 128 return err; 129 130 err = st_accel_common_probe(indio_dev); 131 if (err < 0) 132 goto st_accel_power_off; 133 134 return 0; 135 136 st_accel_power_off: 137 st_sensors_power_disable(indio_dev); 138 139 return err; 140 } 141 142 static int st_accel_spi_remove(struct spi_device *spi) 143 { 144 struct iio_dev *indio_dev = spi_get_drvdata(spi); 145 146 st_sensors_power_disable(indio_dev); 147 148 st_accel_common_remove(indio_dev); 149 150 return 0; 151 } 152 153 static const struct spi_device_id st_accel_id_table[] = { 154 { LIS3DH_ACCEL_DEV_NAME }, 155 { LSM330D_ACCEL_DEV_NAME }, 156 { LSM330DL_ACCEL_DEV_NAME }, 157 { LSM330DLC_ACCEL_DEV_NAME }, 158 { LIS331DLH_ACCEL_DEV_NAME }, 159 { LSM330_ACCEL_DEV_NAME }, 160 { LSM303AGR_ACCEL_DEV_NAME }, 161 { LIS2DH12_ACCEL_DEV_NAME }, 162 { LIS3L02DQ_ACCEL_DEV_NAME }, 163 { LNG2DM_ACCEL_DEV_NAME }, 164 { H3LIS331DL_ACCEL_DEV_NAME }, 165 { LIS331DL_ACCEL_DEV_NAME }, 166 { LIS3LV02DL_ACCEL_DEV_NAME }, 167 { LIS2DW12_ACCEL_DEV_NAME }, 168 { LIS3DHH_ACCEL_DEV_NAME }, 169 { LIS3DE_ACCEL_DEV_NAME }, 170 {}, 171 }; 172 MODULE_DEVICE_TABLE(spi, st_accel_id_table); 173 174 static struct spi_driver st_accel_driver = { 175 .driver = { 176 .name = "st-accel-spi", 177 .of_match_table = st_accel_of_match, 178 }, 179 .probe = st_accel_spi_probe, 180 .remove = st_accel_spi_remove, 181 .id_table = st_accel_id_table, 182 }; 183 module_spi_driver(st_accel_driver); 184 185 MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>"); 186 MODULE_DESCRIPTION("STMicroelectronics accelerometers spi driver"); 187 MODULE_LICENSE("GPL v2"); 188