cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

st_gyro_spi.c (2937B)


      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * STMicroelectronics gyroscopes driver
      4 *
      5 * Copyright 2012-2013 STMicroelectronics Inc.
      6 *
      7 * Denis Ciocca <denis.ciocca@st.com>
      8 */
      9
     10#include <linux/kernel.h>
     11#include <linux/module.h>
     12#include <linux/mod_devicetable.h>
     13#include <linux/spi/spi.h>
     14#include <linux/iio/iio.h>
     15
     16#include <linux/iio/common/st_sensors.h>
     17#include <linux/iio/common/st_sensors_spi.h>
     18#include "st_gyro.h"
     19
     20/*
     21 * For new single-chip sensors use <device_name> as compatible string.
     22 * For old single-chip devices keep <device_name>-gyro to maintain
     23 * compatibility
     24 */
     25static const struct of_device_id st_gyro_of_match[] = {
     26	{
     27		.compatible = "st,l3g4200d-gyro",
     28		.data = L3G4200D_GYRO_DEV_NAME,
     29	},
     30	{
     31		.compatible = "st,lsm330d-gyro",
     32		.data = LSM330D_GYRO_DEV_NAME,
     33	},
     34	{
     35		.compatible = "st,lsm330dl-gyro",
     36		.data = LSM330DL_GYRO_DEV_NAME,
     37	},
     38	{
     39		.compatible = "st,lsm330dlc-gyro",
     40		.data = LSM330DLC_GYRO_DEV_NAME,
     41	},
     42	{
     43		.compatible = "st,l3gd20-gyro",
     44		.data = L3GD20_GYRO_DEV_NAME,
     45	},
     46	{
     47		.compatible = "st,l3gd20h-gyro",
     48		.data = L3GD20H_GYRO_DEV_NAME,
     49	},
     50	{
     51		.compatible = "st,l3g4is-gyro",
     52		.data = L3G4IS_GYRO_DEV_NAME,
     53	},
     54	{
     55		.compatible = "st,lsm330-gyro",
     56		.data = LSM330_GYRO_DEV_NAME,
     57	},
     58	{
     59		.compatible = "st,lsm9ds0-gyro",
     60		.data = LSM9DS0_GYRO_DEV_NAME,
     61	},
     62	{},
     63};
     64MODULE_DEVICE_TABLE(of, st_gyro_of_match);
     65
     66static int st_gyro_spi_probe(struct spi_device *spi)
     67{
     68	const struct st_sensor_settings *settings;
     69	struct st_sensor_data *gdata;
     70	struct iio_dev *indio_dev;
     71	int err;
     72
     73	st_sensors_dev_name_probe(&spi->dev, spi->modalias, sizeof(spi->modalias));
     74
     75	settings = st_gyro_get_settings(spi->modalias);
     76	if (!settings) {
     77		dev_err(&spi->dev, "device name %s not recognized.\n",
     78			spi->modalias);
     79		return -ENODEV;
     80	}
     81
     82	indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*gdata));
     83	if (!indio_dev)
     84		return -ENOMEM;
     85
     86	gdata = iio_priv(indio_dev);
     87	gdata->sensor_settings = (struct st_sensor_settings *)settings;
     88
     89	err = st_sensors_spi_configure(indio_dev, spi);
     90	if (err < 0)
     91		return err;
     92
     93	err = st_sensors_power_enable(indio_dev);
     94	if (err)
     95		return err;
     96
     97	return st_gyro_common_probe(indio_dev);
     98}
     99
    100static const struct spi_device_id st_gyro_id_table[] = {
    101	{ L3G4200D_GYRO_DEV_NAME },
    102	{ LSM330D_GYRO_DEV_NAME },
    103	{ LSM330DL_GYRO_DEV_NAME },
    104	{ LSM330DLC_GYRO_DEV_NAME },
    105	{ L3GD20_GYRO_DEV_NAME },
    106	{ L3GD20H_GYRO_DEV_NAME },
    107	{ L3G4IS_GYRO_DEV_NAME },
    108	{ LSM330_GYRO_DEV_NAME },
    109	{ LSM9DS0_GYRO_DEV_NAME },
    110	{},
    111};
    112MODULE_DEVICE_TABLE(spi, st_gyro_id_table);
    113
    114static struct spi_driver st_gyro_driver = {
    115	.driver = {
    116		.name = "st-gyro-spi",
    117		.of_match_table = st_gyro_of_match,
    118	},
    119	.probe = st_gyro_spi_probe,
    120	.id_table = st_gyro_id_table,
    121};
    122module_spi_driver(st_gyro_driver);
    123
    124MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
    125MODULE_DESCRIPTION("STMicroelectronics gyroscopes spi driver");
    126MODULE_LICENSE("GPL v2");
    127MODULE_IMPORT_NS(IIO_ST_SENSORS);