17be56a8fSDenis Ciocca /* 27be56a8fSDenis Ciocca * STMicroelectronics gyroscopes driver 37be56a8fSDenis Ciocca * 47be56a8fSDenis Ciocca * Copyright 2012-2013 STMicroelectronics Inc. 57be56a8fSDenis Ciocca * 67be56a8fSDenis Ciocca * Denis Ciocca <denis.ciocca@st.com> 77be56a8fSDenis Ciocca * 87be56a8fSDenis Ciocca * Licensed under the GPL-2. 97be56a8fSDenis Ciocca */ 107be56a8fSDenis Ciocca 117be56a8fSDenis Ciocca #include <linux/kernel.h> 127be56a8fSDenis Ciocca #include <linux/module.h> 137be56a8fSDenis Ciocca #include <linux/slab.h> 147be56a8fSDenis Ciocca #include <linux/spi/spi.h> 157be56a8fSDenis Ciocca #include <linux/iio/iio.h> 167be56a8fSDenis Ciocca 177be56a8fSDenis Ciocca #include <linux/iio/common/st_sensors.h> 187be56a8fSDenis Ciocca #include <linux/iio/common/st_sensors_spi.h> 197be56a8fSDenis Ciocca #include "st_gyro.h" 207be56a8fSDenis Ciocca 21794694ceSLorenzo Bianconi #ifdef CONFIG_OF 22794694ceSLorenzo Bianconi /* 23794694ceSLorenzo Bianconi * For new single-chip sensors use <device_name> as compatible string. 24794694ceSLorenzo Bianconi * For old single-chip devices keep <device_name>-gyro to maintain 25794694ceSLorenzo Bianconi * compatibility 26794694ceSLorenzo Bianconi */ 27794694ceSLorenzo Bianconi static const struct of_device_id st_gyro_of_match[] = { 28794694ceSLorenzo Bianconi { 29794694ceSLorenzo Bianconi .compatible = "st,l3g4200d-gyro", 30794694ceSLorenzo Bianconi .data = L3G4200D_GYRO_DEV_NAME, 31794694ceSLorenzo Bianconi }, 32794694ceSLorenzo Bianconi { 33794694ceSLorenzo Bianconi .compatible = "st,lsm330d-gyro", 34794694ceSLorenzo Bianconi .data = LSM330D_GYRO_DEV_NAME, 35794694ceSLorenzo Bianconi }, 36794694ceSLorenzo Bianconi { 37794694ceSLorenzo Bianconi .compatible = "st,lsm330dl-gyro", 38794694ceSLorenzo Bianconi .data = LSM330DL_GYRO_DEV_NAME, 39794694ceSLorenzo Bianconi }, 40794694ceSLorenzo Bianconi { 41794694ceSLorenzo Bianconi .compatible = "st,lsm330dlc-gyro", 42794694ceSLorenzo Bianconi .data = LSM330DLC_GYRO_DEV_NAME, 43794694ceSLorenzo Bianconi }, 44794694ceSLorenzo Bianconi { 45794694ceSLorenzo Bianconi .compatible = "st,l3gd20-gyro", 46794694ceSLorenzo Bianconi .data = L3GD20_GYRO_DEV_NAME, 47794694ceSLorenzo Bianconi }, 48794694ceSLorenzo Bianconi { 49794694ceSLorenzo Bianconi .compatible = "st,l3gd20h-gyro", 50794694ceSLorenzo Bianconi .data = L3GD20H_GYRO_DEV_NAME, 51794694ceSLorenzo Bianconi }, 52794694ceSLorenzo Bianconi { 53794694ceSLorenzo Bianconi .compatible = "st,l3g4is-gyro", 54794694ceSLorenzo Bianconi .data = L3G4IS_GYRO_DEV_NAME, 55794694ceSLorenzo Bianconi }, 56794694ceSLorenzo Bianconi { 57794694ceSLorenzo Bianconi .compatible = "st,lsm330-gyro", 58794694ceSLorenzo Bianconi .data = LSM330_GYRO_DEV_NAME, 59794694ceSLorenzo Bianconi }, 60794694ceSLorenzo Bianconi { 61794694ceSLorenzo Bianconi .compatible = "st,lsm9ds0-gyro", 62794694ceSLorenzo Bianconi .data = LSM9DS0_GYRO_DEV_NAME, 63794694ceSLorenzo Bianconi }, 64794694ceSLorenzo Bianconi {}, 65794694ceSLorenzo Bianconi }; 66794694ceSLorenzo Bianconi MODULE_DEVICE_TABLE(of, st_gyro_of_match); 67794694ceSLorenzo Bianconi #else 68794694ceSLorenzo Bianconi #define st_gyro_of_match NULL 69794694ceSLorenzo Bianconi #endif 70794694ceSLorenzo Bianconi 717be56a8fSDenis Ciocca static int st_gyro_spi_probe(struct spi_device *spi) 727be56a8fSDenis Ciocca { 737be56a8fSDenis Ciocca struct iio_dev *indio_dev; 747be56a8fSDenis Ciocca struct st_sensor_data *gdata; 757be56a8fSDenis Ciocca int err; 767be56a8fSDenis Ciocca 777a842ed6SSachin Kamat indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*gdata)); 787a842ed6SSachin Kamat if (!indio_dev) 797a842ed6SSachin Kamat return -ENOMEM; 807be56a8fSDenis Ciocca 817be56a8fSDenis Ciocca gdata = iio_priv(indio_dev); 827be56a8fSDenis Ciocca 83794694ceSLorenzo Bianconi st_sensors_of_name_probe(&spi->dev, st_gyro_of_match, 84794694ceSLorenzo Bianconi spi->modalias, sizeof(spi->modalias)); 857be56a8fSDenis Ciocca st_sensors_spi_configure(indio_dev, spi, gdata); 867be56a8fSDenis Ciocca 87ef67b341SDenis CIOCCA err = st_gyro_common_probe(indio_dev); 887be56a8fSDenis Ciocca if (err < 0) 897a842ed6SSachin Kamat return err; 907be56a8fSDenis Ciocca 917be56a8fSDenis Ciocca return 0; 927be56a8fSDenis Ciocca } 937be56a8fSDenis Ciocca 947be56a8fSDenis Ciocca static int st_gyro_spi_remove(struct spi_device *spi) 957be56a8fSDenis Ciocca { 967be56a8fSDenis Ciocca st_gyro_common_remove(spi_get_drvdata(spi)); 977be56a8fSDenis Ciocca 987be56a8fSDenis Ciocca return 0; 997be56a8fSDenis Ciocca } 1007be56a8fSDenis Ciocca 1017be56a8fSDenis Ciocca static const struct spi_device_id st_gyro_id_table[] = { 1027be56a8fSDenis Ciocca { L3G4200D_GYRO_DEV_NAME }, 1037be56a8fSDenis Ciocca { LSM330D_GYRO_DEV_NAME }, 1047be56a8fSDenis Ciocca { LSM330DL_GYRO_DEV_NAME }, 1057be56a8fSDenis Ciocca { LSM330DLC_GYRO_DEV_NAME }, 1067be56a8fSDenis Ciocca { L3GD20_GYRO_DEV_NAME }, 10745a4e422SLorenzo Bianconi { L3GD20H_GYRO_DEV_NAME }, 1087be56a8fSDenis Ciocca { L3G4IS_GYRO_DEV_NAME }, 1097be56a8fSDenis Ciocca { LSM330_GYRO_DEV_NAME }, 11041c128cbSCrestez Dan Leonard { LSM9DS0_GYRO_DEV_NAME }, 1117be56a8fSDenis Ciocca {}, 1127be56a8fSDenis Ciocca }; 1137be56a8fSDenis Ciocca MODULE_DEVICE_TABLE(spi, st_gyro_id_table); 1147be56a8fSDenis Ciocca 1157be56a8fSDenis Ciocca static struct spi_driver st_gyro_driver = { 1167be56a8fSDenis Ciocca .driver = { 1177be56a8fSDenis Ciocca .name = "st-gyro-spi", 118794694ceSLorenzo Bianconi .of_match_table = of_match_ptr(st_gyro_of_match), 1197be56a8fSDenis Ciocca }, 1207be56a8fSDenis Ciocca .probe = st_gyro_spi_probe, 1217be56a8fSDenis Ciocca .remove = st_gyro_spi_remove, 1227be56a8fSDenis Ciocca .id_table = st_gyro_id_table, 1237be56a8fSDenis Ciocca }; 1247be56a8fSDenis Ciocca module_spi_driver(st_gyro_driver); 1257be56a8fSDenis Ciocca 1267be56a8fSDenis Ciocca MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>"); 1277be56a8fSDenis Ciocca MODULE_DESCRIPTION("STMicroelectronics gyroscopes spi driver"); 1287be56a8fSDenis Ciocca MODULE_LICENSE("GPL v2"); 129