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/i2c.h>
14#include <linux/iio/iio.h>
15
16#include <linux/iio/common/st_sensors.h>
17#include <linux/iio/common/st_sensors_i2c.h>
18#include "st_gyro.h"
19
20static const struct of_device_id st_gyro_of_match[] = {
21	{
22		.compatible = "st,l3g4200d-gyro",
23		.data = L3G4200D_GYRO_DEV_NAME,
24	},
25	{
26		.compatible = "st,lsm330d-gyro",
27		.data = LSM330D_GYRO_DEV_NAME,
28	},
29	{
30		.compatible = "st,lsm330dl-gyro",
31		.data = LSM330DL_GYRO_DEV_NAME,
32	},
33	{
34		.compatible = "st,lsm330dlc-gyro",
35		.data = LSM330DLC_GYRO_DEV_NAME,
36	},
37	{
38		.compatible = "st,l3gd20-gyro",
39		.data = L3GD20_GYRO_DEV_NAME,
40	},
41	{
42		.compatible = "st,l3gd20h-gyro",
43		.data = L3GD20H_GYRO_DEV_NAME,
44	},
45	{
46		.compatible = "st,l3g4is-gyro",
47		.data = L3G4IS_GYRO_DEV_NAME,
48	},
49	{
50		.compatible = "st,lsm330-gyro",
51		.data = LSM330_GYRO_DEV_NAME,
52	},
53	{
54		.compatible = "st,lsm9ds0-gyro",
55		.data = LSM9DS0_GYRO_DEV_NAME,
56	},
57	{},
58};
59MODULE_DEVICE_TABLE(of, st_gyro_of_match);
60
61static int st_gyro_i2c_probe(struct i2c_client *client)
62{
63	const struct st_sensor_settings *settings;
64	struct st_sensor_data *gdata;
65	struct iio_dev *indio_dev;
66	int err;
67
68	st_sensors_dev_name_probe(&client->dev, client->name, sizeof(client->name));
69
70	settings = st_gyro_get_settings(client->name);
71	if (!settings) {
72		dev_err(&client->dev, "device name %s not recognized.\n",
73			client->name);
74		return -ENODEV;
75	}
76
77	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*gdata));
78	if (!indio_dev)
79		return -ENOMEM;
80
81	gdata = iio_priv(indio_dev);
82	gdata->sensor_settings = (struct st_sensor_settings *)settings;
83
84	err = st_sensors_i2c_configure(indio_dev, client);
85	if (err < 0)
86		return err;
87
88	err = st_sensors_power_enable(indio_dev);
89	if (err)
90		return err;
91
92	return st_gyro_common_probe(indio_dev);
93}
94
95static const struct i2c_device_id st_gyro_id_table[] = {
96	{ L3G4200D_GYRO_DEV_NAME },
97	{ LSM330D_GYRO_DEV_NAME },
98	{ LSM330DL_GYRO_DEV_NAME },
99	{ LSM330DLC_GYRO_DEV_NAME },
100	{ L3GD20_GYRO_DEV_NAME },
101	{ L3GD20H_GYRO_DEV_NAME },
102	{ L3G4IS_GYRO_DEV_NAME },
103	{ LSM330_GYRO_DEV_NAME },
104	{ LSM9DS0_GYRO_DEV_NAME },
105	{},
106};
107MODULE_DEVICE_TABLE(i2c, st_gyro_id_table);
108
109static struct i2c_driver st_gyro_driver = {
110	.driver = {
111		.name = "st-gyro-i2c",
112		.of_match_table = st_gyro_of_match,
113	},
114	.probe = st_gyro_i2c_probe,
115	.id_table = st_gyro_id_table,
116};
117module_i2c_driver(st_gyro_driver);
118
119MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
120MODULE_DESCRIPTION("STMicroelectronics gyroscopes i2c driver");
121MODULE_LICENSE("GPL v2");
122MODULE_IMPORT_NS(IIO_ST_SENSORS);
123