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 #ifdef CONFIG_OF 21794694ceSLorenzo Bianconi /* 22794694ceSLorenzo Bianconi * For new single-chip sensors use <device_name> as compatible string. 23794694ceSLorenzo Bianconi * For old single-chip devices keep <device_name>-gyro to maintain 24794694ceSLorenzo Bianconi * compatibility 25794694ceSLorenzo Bianconi */ 26794694ceSLorenzo Bianconi static const struct of_device_id st_gyro_of_match[] = { 27794694ceSLorenzo Bianconi { 28794694ceSLorenzo Bianconi .compatible = "st,l3g4200d-gyro", 29794694ceSLorenzo Bianconi .data = L3G4200D_GYRO_DEV_NAME, 30794694ceSLorenzo Bianconi }, 31794694ceSLorenzo Bianconi { 32794694ceSLorenzo Bianconi .compatible = "st,lsm330d-gyro", 33794694ceSLorenzo Bianconi .data = LSM330D_GYRO_DEV_NAME, 34794694ceSLorenzo Bianconi }, 35794694ceSLorenzo Bianconi { 36794694ceSLorenzo Bianconi .compatible = "st,lsm330dl-gyro", 37794694ceSLorenzo Bianconi .data = LSM330DL_GYRO_DEV_NAME, 38794694ceSLorenzo Bianconi }, 39794694ceSLorenzo Bianconi { 40794694ceSLorenzo Bianconi .compatible = "st,lsm330dlc-gyro", 41794694ceSLorenzo Bianconi .data = LSM330DLC_GYRO_DEV_NAME, 42794694ceSLorenzo Bianconi }, 43794694ceSLorenzo Bianconi { 44794694ceSLorenzo Bianconi .compatible = "st,l3gd20-gyro", 45794694ceSLorenzo Bianconi .data = L3GD20_GYRO_DEV_NAME, 46794694ceSLorenzo Bianconi }, 47794694ceSLorenzo Bianconi { 48794694ceSLorenzo Bianconi .compatible = "st,l3gd20h-gyro", 49794694ceSLorenzo Bianconi .data = L3GD20H_GYRO_DEV_NAME, 50794694ceSLorenzo Bianconi }, 51794694ceSLorenzo Bianconi { 52794694ceSLorenzo Bianconi .compatible = "st,l3g4is-gyro", 53794694ceSLorenzo Bianconi .data = L3G4IS_GYRO_DEV_NAME, 54794694ceSLorenzo Bianconi }, 55794694ceSLorenzo Bianconi { 56794694ceSLorenzo Bianconi .compatible = "st,lsm330-gyro", 57794694ceSLorenzo Bianconi .data = LSM330_GYRO_DEV_NAME, 58794694ceSLorenzo Bianconi }, 59794694ceSLorenzo Bianconi { 60794694ceSLorenzo Bianconi .compatible = "st,lsm9ds0-gyro", 61794694ceSLorenzo Bianconi .data = LSM9DS0_GYRO_DEV_NAME, 62794694ceSLorenzo Bianconi }, 63794694ceSLorenzo Bianconi {}, 64794694ceSLorenzo Bianconi }; 65794694ceSLorenzo Bianconi MODULE_DEVICE_TABLE(of, st_gyro_of_match); 66794694ceSLorenzo Bianconi #else 67794694ceSLorenzo Bianconi #define st_gyro_of_match NULL 68794694ceSLorenzo Bianconi #endif 69794694ceSLorenzo Bianconi 707be56a8fSDenis Ciocca static int st_gyro_spi_probe(struct spi_device *spi) 717be56a8fSDenis Ciocca { 723c05484cSDenis Ciocca const struct st_sensor_settings *settings; 737be56a8fSDenis Ciocca struct st_sensor_data *gdata; 743c05484cSDenis Ciocca struct iio_dev *indio_dev; 757be56a8fSDenis Ciocca int err; 767be56a8fSDenis Ciocca 773c05484cSDenis Ciocca st_sensors_of_name_probe(&spi->dev, st_gyro_of_match, 783c05484cSDenis Ciocca spi->modalias, sizeof(spi->modalias)); 793c05484cSDenis Ciocca 803c05484cSDenis Ciocca settings = st_gyro_get_settings(spi->modalias); 813c05484cSDenis Ciocca if (!settings) { 823c05484cSDenis Ciocca dev_err(&spi->dev, "device name %s not recognized.\n", 833c05484cSDenis Ciocca spi->modalias); 843c05484cSDenis Ciocca return -ENODEV; 853c05484cSDenis Ciocca } 863c05484cSDenis Ciocca 877a842ed6SSachin Kamat indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*gdata)); 887a842ed6SSachin Kamat if (!indio_dev) 897a842ed6SSachin Kamat return -ENOMEM; 907be56a8fSDenis Ciocca 917be56a8fSDenis Ciocca gdata = iio_priv(indio_dev); 923c05484cSDenis Ciocca gdata->sensor_settings = (struct st_sensor_settings *)settings; 937be56a8fSDenis Ciocca 941ecd245eSDenis Ciocca err = st_sensors_spi_configure(indio_dev, spi); 951ecd245eSDenis Ciocca if (err < 0) 961ecd245eSDenis Ciocca return err; 977be56a8fSDenis Ciocca 98ef67b341SDenis CIOCCA err = st_gyro_common_probe(indio_dev); 997be56a8fSDenis Ciocca if (err < 0) 1007a842ed6SSachin Kamat return err; 1017be56a8fSDenis Ciocca 1027be56a8fSDenis Ciocca return 0; 1037be56a8fSDenis Ciocca } 1047be56a8fSDenis Ciocca 1057be56a8fSDenis Ciocca static int st_gyro_spi_remove(struct spi_device *spi) 1067be56a8fSDenis Ciocca { 1077be56a8fSDenis Ciocca st_gyro_common_remove(spi_get_drvdata(spi)); 1087be56a8fSDenis Ciocca 1097be56a8fSDenis Ciocca return 0; 1107be56a8fSDenis Ciocca } 1117be56a8fSDenis Ciocca 1127be56a8fSDenis Ciocca static const struct spi_device_id st_gyro_id_table[] = { 1137be56a8fSDenis Ciocca { L3G4200D_GYRO_DEV_NAME }, 1147be56a8fSDenis Ciocca { LSM330D_GYRO_DEV_NAME }, 1157be56a8fSDenis Ciocca { LSM330DL_GYRO_DEV_NAME }, 1167be56a8fSDenis Ciocca { LSM330DLC_GYRO_DEV_NAME }, 1177be56a8fSDenis Ciocca { L3GD20_GYRO_DEV_NAME }, 11845a4e422SLorenzo Bianconi { L3GD20H_GYRO_DEV_NAME }, 1197be56a8fSDenis Ciocca { L3G4IS_GYRO_DEV_NAME }, 1207be56a8fSDenis Ciocca { LSM330_GYRO_DEV_NAME }, 12141c128cbSCrestez Dan Leonard { LSM9DS0_GYRO_DEV_NAME }, 1227be56a8fSDenis Ciocca {}, 1237be56a8fSDenis Ciocca }; 1247be56a8fSDenis Ciocca MODULE_DEVICE_TABLE(spi, st_gyro_id_table); 1257be56a8fSDenis Ciocca 1267be56a8fSDenis Ciocca static struct spi_driver st_gyro_driver = { 1277be56a8fSDenis Ciocca .driver = { 1287be56a8fSDenis Ciocca .name = "st-gyro-spi", 129794694ceSLorenzo Bianconi .of_match_table = of_match_ptr(st_gyro_of_match), 1307be56a8fSDenis Ciocca }, 1317be56a8fSDenis Ciocca .probe = st_gyro_spi_probe, 1327be56a8fSDenis Ciocca .remove = st_gyro_spi_remove, 1337be56a8fSDenis Ciocca .id_table = st_gyro_id_table, 1347be56a8fSDenis Ciocca }; 1357be56a8fSDenis Ciocca module_spi_driver(st_gyro_driver); 1367be56a8fSDenis Ciocca 1377be56a8fSDenis Ciocca MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>"); 1387be56a8fSDenis Ciocca MODULE_DESCRIPTION("STMicroelectronics gyroscopes spi driver"); 1397be56a8fSDenis Ciocca MODULE_LICENSE("GPL v2"); 140