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_accel_spi.c (3953B)

      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * STMicroelectronics accelerometers 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_accel.h"
     19
     20/*
     21 * For new single-chip sensors use <device_name> as compatible string.
     22 * For old single-chip devices keep <device_name>-accel to maintain
     23 * compatibility
     24 */
     25static const struct of_device_id st_accel_of_match[] = {
     26	{
     27		/* An older compatible */
     28		.compatible = "st,lis302dl-spi",
     29		.data = LIS3LV02DL_ACCEL_DEV_NAME,
     30	},
     31	{
     32		.compatible = "st,lis3lv02dl-accel",
     33		.data = LIS3LV02DL_ACCEL_DEV_NAME,
     34	},
     35	{
     36		.compatible = "st,lis3dh-accel",
     37		.data = LIS3DH_ACCEL_DEV_NAME,
     38	},
     39	{
     40		.compatible = "st,lsm330d-accel",
     41		.data = LSM330D_ACCEL_DEV_NAME,
     42	},
     43	{
     44		.compatible = "st,lsm330dl-accel",
     45		.data = LSM330DL_ACCEL_DEV_NAME,
     46	},
     47	{
     48		.compatible = "st,lsm330dlc-accel",
     49		.data = LSM330DLC_ACCEL_DEV_NAME,
     50	},
     51	{
     52		.compatible = "st,lis331dlh-accel",
     53		.data = LIS331DLH_ACCEL_DEV_NAME,
     54	},
     55	{
     56		.compatible = "st,lsm330-accel",
     57		.data = LSM330_ACCEL_DEV_NAME,
     58	},
     59	{
     60		.compatible = "st,lsm303agr-accel",
     61		.data = LSM303AGR_ACCEL_DEV_NAME,
     62	},
     63	{
     64		.compatible = "st,lis2dh12-accel",
     65		.data = LIS2DH12_ACCEL_DEV_NAME,
     66	},
     67	{
     68		.compatible = "st,lis3l02dq",
     69		.data = LIS3L02DQ_ACCEL_DEV_NAME,
     70	},
     71	{
     72		.compatible = "st,lng2dm-accel",
     73		.data = LNG2DM_ACCEL_DEV_NAME,
     74	},
     75	{
     76		.compatible = "st,h3lis331dl-accel",
     77		.data = H3LIS331DL_ACCEL_DEV_NAME,
     78	},
     79	{
     80		.compatible = "st,lis331dl-accel",
     81		.data = LIS331DL_ACCEL_DEV_NAME,
     82	},
     83	{
     84		.compatible = "st,lis2dw12",
     85		.data = LIS2DW12_ACCEL_DEV_NAME,
     86	},
     87	{
     88		.compatible = "st,lis3dhh",
     89		.data = LIS3DHH_ACCEL_DEV_NAME,
     90	},
     91	{
     92		.compatible = "st,lis3de",
     93		.data = LIS3DE_ACCEL_DEV_NAME,
     94	},
     95	{
     96		.compatible = "st,lis302dl",
     97		.data = LIS302DL_ACCEL_DEV_NAME,
     98	},
     99	{}
    100};
    101MODULE_DEVICE_TABLE(of, st_accel_of_match);
    102
    103static int st_accel_spi_probe(struct spi_device *spi)
    104{
    105	const struct st_sensor_settings *settings;
    106	struct st_sensor_data *adata;
    107	struct iio_dev *indio_dev;
    108	int err;
    109
    110	st_sensors_dev_name_probe(&spi->dev, spi->modalias, sizeof(spi->modalias));
    111
    112	settings = st_accel_get_settings(spi->modalias);
    113	if (!settings) {
    114		dev_err(&spi->dev, "device name %s not recognized.\n",
    115			spi->modalias);
    116		return -ENODEV;
    117	}
    118
    119	indio_dev = devm_iio_device_alloc(&spi->dev, sizeof(*adata));
    120	if (!indio_dev)
    121		return -ENOMEM;
    122
    123	adata = iio_priv(indio_dev);
    124	adata->sensor_settings = (struct st_sensor_settings *)settings;
    125
    126	err = st_sensors_spi_configure(indio_dev, spi);
    127	if (err < 0)
    128		return err;
    129
    130	err = st_sensors_power_enable(indio_dev);
    131	if (err)
    132		return err;
    133
    134	return st_accel_common_probe(indio_dev);
    135}
    136
    137static const struct spi_device_id st_accel_id_table[] = {
    138	{ LIS3DH_ACCEL_DEV_NAME },
    139	{ LSM330D_ACCEL_DEV_NAME },
    140	{ LSM330DL_ACCEL_DEV_NAME },
    141	{ LSM330DLC_ACCEL_DEV_NAME },
    142	{ LIS331DLH_ACCEL_DEV_NAME },
    143	{ LSM330_ACCEL_DEV_NAME },
    144	{ LSM303AGR_ACCEL_DEV_NAME },
    145	{ LIS2DH12_ACCEL_DEV_NAME },
    146	{ LIS3L02DQ_ACCEL_DEV_NAME },
    147	{ LNG2DM_ACCEL_DEV_NAME },
    148	{ H3LIS331DL_ACCEL_DEV_NAME },
    149	{ LIS331DL_ACCEL_DEV_NAME },
    150	{ LIS3LV02DL_ACCEL_DEV_NAME },
    151	{ LIS2DW12_ACCEL_DEV_NAME },
    152	{ LIS3DHH_ACCEL_DEV_NAME },
    153	{ LIS3DE_ACCEL_DEV_NAME },
    154	{ LIS302DL_ACCEL_DEV_NAME },
    155	{},
    156};
    157MODULE_DEVICE_TABLE(spi, st_accel_id_table);
    158
    159static struct spi_driver st_accel_driver = {
    160	.driver = {
    161		.name = "st-accel-spi",
    162		.of_match_table = st_accel_of_match,
    163	},
    164	.probe = st_accel_spi_probe,
    165	.id_table = st_accel_id_table,
    166};
    167module_spi_driver(st_accel_driver);
    168
    169MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
    170MODULE_DESCRIPTION("STMicroelectronics accelerometers spi driver");
    171MODULE_LICENSE("GPL v2");
    172MODULE_IMPORT_NS(IIO_ST_SENSORS);