1fda8d26eSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 27be56a8fSDenis Ciocca /* 37be56a8fSDenis Ciocca * STMicroelectronics gyroscopes driver 47be56a8fSDenis Ciocca * 57be56a8fSDenis Ciocca * Copyright 2012-2013 STMicroelectronics Inc. 67be56a8fSDenis Ciocca * 77be56a8fSDenis Ciocca * Denis Ciocca <denis.ciocca@st.com> 87be56a8fSDenis Ciocca */ 97be56a8fSDenis Ciocca 107be56a8fSDenis Ciocca #include <linux/kernel.h> 117be56a8fSDenis Ciocca #include <linux/module.h> 127be56a8fSDenis Ciocca #include <linux/slab.h> 137be56a8fSDenis Ciocca #include <linux/spi/spi.h> 147be56a8fSDenis Ciocca #include <linux/iio/iio.h> 157be56a8fSDenis Ciocca 167be56a8fSDenis Ciocca #include <linux/iio/common/st_sensors.h> 177be56a8fSDenis Ciocca #include <linux/iio/common/st_sensors_spi.h> 187be56a8fSDenis Ciocca #include "st_gyro.h" 197be56a8fSDenis Ciocca 20794694ceSLorenzo Bianconi /* 21794694ceSLorenzo Bianconi * For new single-chip sensors use <device_name> as compatible string. 22794694ceSLorenzo Bianconi * For old single-chip devices keep <device_name>-gyro to maintain 23794694ceSLorenzo Bianconi * compatibility 24794694ceSLorenzo Bianconi */ 25794694ceSLorenzo Bianconi static const struct of_device_id st_gyro_of_match[] = { 26794694ceSLorenzo Bianconi { 27794694ceSLorenzo Bianconi .compatible = "st,l3g4200d-gyro", 28794694ceSLorenzo Bianconi .data = L3G4200D_GYRO_DEV_NAME, 29794694ceSLorenzo Bianconi }, 30794694ceSLorenzo Bianconi { 31794694ceSLorenzo Bianconi .compatible = "st,lsm330d-gyro", 32794694ceSLorenzo Bianconi .data = LSM330D_GYRO_DEV_NAME, 33794694ceSLorenzo Bianconi }, 34794694ceSLorenzo Bianconi { 35794694ceSLorenzo Bianconi .compatible = "st,lsm330dl-gyro", 36794694ceSLorenzo Bianconi .data = LSM330DL_GYRO_DEV_NAME, 37794694ceSLorenzo Bianconi }, 38794694ceSLorenzo Bianconi { 39794694ceSLorenzo Bianconi .compatible = "st,lsm330dlc-gyro", 40794694ceSLorenzo Bianconi .data = LSM330DLC_GYRO_DEV_NAME, 41794694ceSLorenzo Bianconi }, 42794694ceSLorenzo Bianconi { 43794694ceSLorenzo Bianconi .compatible = "st,l3gd20-gyro", 44794694ceSLorenzo Bianconi .data = L3GD20_GYRO_DEV_NAME, 45794694ceSLorenzo Bianconi }, 46794694ceSLorenzo Bianconi { 47794694ceSLorenzo Bianconi .compatible = "st,l3gd20h-gyro", 48794694ceSLorenzo Bianconi .data = L3GD20H_GYRO_DEV_NAME, 49794694ceSLorenzo Bianconi }, 50794694ceSLorenzo Bianconi { 51794694ceSLorenzo Bianconi .compatible = "st,l3g4is-gyro", 52794694ceSLorenzo Bianconi .data = L3G4IS_GYRO_DEV_NAME, 53794694ceSLorenzo Bianconi }, 54794694ceSLorenzo Bianconi { 55794694ceSLorenzo Bianconi .compatible = "st,lsm330-gyro", 56794694ceSLorenzo Bianconi .data = LSM330_GYRO_DEV_NAME, 57794694ceSLorenzo Bianconi }, 58794694ceSLorenzo Bianconi { 59794694ceSLorenzo Bianconi .compatible = "st,lsm9ds0-gyro", 60794694ceSLorenzo Bianconi .data = LSM9DS0_GYRO_DEV_NAME, 61794694ceSLorenzo Bianconi }, 62794694ceSLorenzo Bianconi {}, 63794694ceSLorenzo Bianconi }; 64794694ceSLorenzo Bianconi MODULE_DEVICE_TABLE(of, st_gyro_of_match); 65794694ceSLorenzo Bianconi 667be56a8fSDenis Ciocca static int st_gyro_spi_probe(struct spi_device *spi) 677be56a8fSDenis Ciocca { 683c05484cSDenis Ciocca const struct st_sensor_settings *settings; 697be56a8fSDenis Ciocca struct st_sensor_data *gdata; 703c05484cSDenis Ciocca struct iio_dev *indio_dev; 717be56a8fSDenis Ciocca int err; 727be56a8fSDenis Ciocca 73efc78983SAndy Shevchenko st_sensors_dev_name_probe(&spi->dev, spi->modalias, sizeof(spi->modalias)); 743c05484cSDenis Ciocca 753c05484cSDenis Ciocca settings = st_gyro_get_settings(spi->modalias); 763c05484cSDenis Ciocca if (!settings) { 773c05484cSDenis Ciocca dev_err(&spi->dev, "device name %s not recognized.\n", 783c05484cSDenis Ciocca spi->modalias); 793c05484cSDenis Ciocca return -ENODEV; 803c05484cSDenis Ciocca } 813c05484cSDenis Ciocca 827a842ed6SSachin Kamat indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*gdata)); 837a842ed6SSachin Kamat if (!indio_dev) 847a842ed6SSachin Kamat return -ENOMEM; 857be56a8fSDenis Ciocca 867be56a8fSDenis Ciocca gdata = iio_priv(indio_dev); 873c05484cSDenis Ciocca gdata->sensor_settings = (struct st_sensor_settings *)settings; 887be56a8fSDenis Ciocca 891ecd245eSDenis Ciocca err = st_sensors_spi_configure(indio_dev, spi); 901ecd245eSDenis Ciocca if (err < 0) 911ecd245eSDenis Ciocca return err; 927be56a8fSDenis Ciocca 93ef67b341SDenis CIOCCA err = st_gyro_common_probe(indio_dev); 947be56a8fSDenis Ciocca if (err < 0) 957a842ed6SSachin Kamat return err; 967be56a8fSDenis Ciocca 977be56a8fSDenis Ciocca return 0; 987be56a8fSDenis Ciocca } 997be56a8fSDenis Ciocca 1007be56a8fSDenis Ciocca static int st_gyro_spi_remove(struct spi_device *spi) 1017be56a8fSDenis Ciocca { 1027be56a8fSDenis Ciocca st_gyro_common_remove(spi_get_drvdata(spi)); 1037be56a8fSDenis Ciocca 1047be56a8fSDenis Ciocca return 0; 1057be56a8fSDenis Ciocca } 1067be56a8fSDenis Ciocca 1077be56a8fSDenis Ciocca static const struct spi_device_id st_gyro_id_table[] = { 1087be56a8fSDenis Ciocca { L3G4200D_GYRO_DEV_NAME }, 1097be56a8fSDenis Ciocca { LSM330D_GYRO_DEV_NAME }, 1107be56a8fSDenis Ciocca { LSM330DL_GYRO_DEV_NAME }, 1117be56a8fSDenis Ciocca { LSM330DLC_GYRO_DEV_NAME }, 1127be56a8fSDenis Ciocca { L3GD20_GYRO_DEV_NAME }, 11345a4e422SLorenzo Bianconi { L3GD20H_GYRO_DEV_NAME }, 1147be56a8fSDenis Ciocca { L3G4IS_GYRO_DEV_NAME }, 1157be56a8fSDenis Ciocca { LSM330_GYRO_DEV_NAME }, 11641c128cbSCrestez Dan Leonard { LSM9DS0_GYRO_DEV_NAME }, 1177be56a8fSDenis Ciocca {}, 1187be56a8fSDenis Ciocca }; 1197be56a8fSDenis Ciocca MODULE_DEVICE_TABLE(spi, st_gyro_id_table); 1207be56a8fSDenis Ciocca 1217be56a8fSDenis Ciocca static struct spi_driver st_gyro_driver = { 1227be56a8fSDenis Ciocca .driver = { 1237be56a8fSDenis Ciocca .name = "st-gyro-spi", 124ecb27c5eSAndy Shevchenko .of_match_table = st_gyro_of_match, 1257be56a8fSDenis Ciocca }, 1267be56a8fSDenis Ciocca .probe = st_gyro_spi_probe, 1277be56a8fSDenis Ciocca .remove = st_gyro_spi_remove, 1287be56a8fSDenis Ciocca .id_table = st_gyro_id_table, 1297be56a8fSDenis Ciocca }; 1307be56a8fSDenis Ciocca module_spi_driver(st_gyro_driver); 1317be56a8fSDenis Ciocca 1327be56a8fSDenis Ciocca MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>"); 1337be56a8fSDenis Ciocca MODULE_DESCRIPTION("STMicroelectronics gyroscopes spi driver"); 1347be56a8fSDenis Ciocca MODULE_LICENSE("GPL v2"); 135