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 { 727be56a8fSDenis Ciocca struct iio_dev *indio_dev; 737be56a8fSDenis Ciocca struct st_sensor_data *gdata; 747be56a8fSDenis Ciocca int err; 757be56a8fSDenis Ciocca 767a842ed6SSachin Kamat indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*gdata)); 777a842ed6SSachin Kamat if (!indio_dev) 787a842ed6SSachin Kamat return -ENOMEM; 797be56a8fSDenis Ciocca 807be56a8fSDenis Ciocca gdata = iio_priv(indio_dev); 817be56a8fSDenis Ciocca 82794694ceSLorenzo Bianconi st_sensors_of_name_probe(&spi->dev, st_gyro_of_match, 83794694ceSLorenzo Bianconi spi->modalias, sizeof(spi->modalias)); 847be56a8fSDenis Ciocca st_sensors_spi_configure(indio_dev, spi, gdata); 857be56a8fSDenis Ciocca 86ef67b341SDenis CIOCCA err = st_gyro_common_probe(indio_dev); 877be56a8fSDenis Ciocca if (err < 0) 887a842ed6SSachin Kamat return err; 897be56a8fSDenis Ciocca 907be56a8fSDenis Ciocca return 0; 917be56a8fSDenis Ciocca } 927be56a8fSDenis Ciocca 937be56a8fSDenis Ciocca static int st_gyro_spi_remove(struct spi_device *spi) 947be56a8fSDenis Ciocca { 957be56a8fSDenis Ciocca st_gyro_common_remove(spi_get_drvdata(spi)); 967be56a8fSDenis Ciocca 977be56a8fSDenis Ciocca return 0; 987be56a8fSDenis Ciocca } 997be56a8fSDenis Ciocca 1007be56a8fSDenis Ciocca static const struct spi_device_id st_gyro_id_table[] = { 1017be56a8fSDenis Ciocca { L3G4200D_GYRO_DEV_NAME }, 1027be56a8fSDenis Ciocca { LSM330D_GYRO_DEV_NAME }, 1037be56a8fSDenis Ciocca { LSM330DL_GYRO_DEV_NAME }, 1047be56a8fSDenis Ciocca { LSM330DLC_GYRO_DEV_NAME }, 1057be56a8fSDenis Ciocca { L3GD20_GYRO_DEV_NAME }, 10645a4e422SLorenzo Bianconi { L3GD20H_GYRO_DEV_NAME }, 1077be56a8fSDenis Ciocca { L3G4IS_GYRO_DEV_NAME }, 1087be56a8fSDenis Ciocca { LSM330_GYRO_DEV_NAME }, 10941c128cbSCrestez Dan Leonard { LSM9DS0_GYRO_DEV_NAME }, 1107be56a8fSDenis Ciocca {}, 1117be56a8fSDenis Ciocca }; 1127be56a8fSDenis Ciocca MODULE_DEVICE_TABLE(spi, st_gyro_id_table); 1137be56a8fSDenis Ciocca 1147be56a8fSDenis Ciocca static struct spi_driver st_gyro_driver = { 1157be56a8fSDenis Ciocca .driver = { 1167be56a8fSDenis Ciocca .name = "st-gyro-spi", 117794694ceSLorenzo Bianconi .of_match_table = of_match_ptr(st_gyro_of_match), 1187be56a8fSDenis Ciocca }, 1197be56a8fSDenis Ciocca .probe = st_gyro_spi_probe, 1207be56a8fSDenis Ciocca .remove = st_gyro_spi_remove, 1217be56a8fSDenis Ciocca .id_table = st_gyro_id_table, 1227be56a8fSDenis Ciocca }; 1237be56a8fSDenis Ciocca module_spi_driver(st_gyro_driver); 1247be56a8fSDenis Ciocca 1257be56a8fSDenis Ciocca MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>"); 1267be56a8fSDenis Ciocca MODULE_DESCRIPTION("STMicroelectronics gyroscopes spi driver"); 1277be56a8fSDenis Ciocca MODULE_LICENSE("GPL v2"); 128