Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 | // SPDX-License-Identifier: GPL-2.0-only /* * STMicroelectronics magnetometers driver * * Copyright 2012-2013 STMicroelectronics Inc. * * Denis Ciocca <denis.ciocca@st.com> */ #include <linux/kernel.h> #include <linux/module.h> #include <linux/slab.h> #include <linux/spi/spi.h> #include <linux/iio/iio.h> #include <linux/iio/common/st_sensors.h> #include <linux/iio/common/st_sensors_spi.h> #include "st_magn.h" #ifdef CONFIG_OF /* * For new single-chip sensors use <device_name> as compatible string. * For old single-chip devices keep <device_name>-magn to maintain * compatibility * For multi-chip devices, use <device_name>-magn to distinguish which * capability is being used */ static const struct of_device_id st_magn_of_match[] = { { .compatible = "st,lis3mdl-magn", .data = LIS3MDL_MAGN_DEV_NAME, }, { .compatible = "st,lsm303agr-magn", .data = LSM303AGR_MAGN_DEV_NAME, }, { .compatible = "st,lis2mdl", .data = LIS2MDL_MAGN_DEV_NAME, }, { .compatible = "st,lsm9ds1-magn", .data = LSM9DS1_MAGN_DEV_NAME, }, {} }; MODULE_DEVICE_TABLE(of, st_magn_of_match); #else #define st_magn_of_match NULL #endif static int st_magn_spi_probe(struct spi_device *spi) { const struct st_sensor_settings *settings; struct st_sensor_data *mdata; struct iio_dev *indio_dev; int err; st_sensors_of_name_probe(&spi->dev, st_magn_of_match, spi->modalias, sizeof(spi->modalias)); settings = st_magn_get_settings(spi->modalias); if (!settings) { dev_err(&spi->dev, "device name %s not recognized.\n", spi->modalias); return -ENODEV; } indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*mdata)); if (!indio_dev) return -ENOMEM; mdata = iio_priv(indio_dev); mdata->sensor_settings = (struct st_sensor_settings *)settings; err = st_sensors_spi_configure(indio_dev, spi); if (err < 0) return err; err = st_magn_common_probe(indio_dev); if (err < 0) return err; return 0; } static int st_magn_spi_remove(struct spi_device *spi) { struct iio_dev *indio_dev = spi_get_drvdata(spi); st_magn_common_remove(indio_dev); return 0; } static const struct spi_device_id st_magn_id_table[] = { { LIS3MDL_MAGN_DEV_NAME }, { LSM303AGR_MAGN_DEV_NAME }, { LIS2MDL_MAGN_DEV_NAME }, { LSM9DS1_MAGN_DEV_NAME }, {}, }; MODULE_DEVICE_TABLE(spi, st_magn_id_table); static struct spi_driver st_magn_driver = { .driver = { .name = "st-magn-spi", .of_match_table = of_match_ptr(st_magn_of_match), }, .probe = st_magn_spi_probe, .remove = st_magn_spi_remove, .id_table = st_magn_id_table, }; module_spi_driver(st_magn_driver); MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>"); MODULE_DESCRIPTION("STMicroelectronics magnetometers spi driver"); MODULE_LICENSE("GPL v2"); |