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/slab.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			     const struct i2c_device_id *id)
63{
64	const struct st_sensor_settings *settings;
65	struct st_sensor_data *gdata;
66	struct iio_dev *indio_dev;
67	int err;
68
69	st_sensors_dev_name_probe(&client->dev, client->name, sizeof(client->name));
70
71	settings = st_gyro_get_settings(client->name);
72	if (!settings) {
73		dev_err(&client->dev, "device name %s not recognized.\n",
74			client->name);
75		return -ENODEV;
76	}
77
78	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*gdata));
79	if (!indio_dev)
80		return -ENOMEM;
81
82	gdata = iio_priv(indio_dev);
83	gdata->sensor_settings = (struct st_sensor_settings *)settings;
84
85	err = st_sensors_i2c_configure(indio_dev, client);
86	if (err < 0)
87		return err;
88
89	err = st_sensors_power_enable(indio_dev);
90	if (err)
91		return err;
92
93	err = st_gyro_common_probe(indio_dev);
94	if (err < 0)
95		goto st_gyro_power_off;
96
97	return 0;
98
99st_gyro_power_off:
100	st_sensors_power_disable(indio_dev);
101
102	return err;
103}
104
105static int st_gyro_i2c_remove(struct i2c_client *client)
106{
107	struct iio_dev *indio_dev = i2c_get_clientdata(client);
108
109	st_gyro_common_remove(indio_dev);
110
111	st_sensors_power_disable(indio_dev);
112
113	return 0;
114}
115
116static const struct i2c_device_id st_gyro_id_table[] = {
117	{ L3G4200D_GYRO_DEV_NAME },
118	{ LSM330D_GYRO_DEV_NAME },
119	{ LSM330DL_GYRO_DEV_NAME },
120	{ LSM330DLC_GYRO_DEV_NAME },
121	{ L3GD20_GYRO_DEV_NAME },
122	{ L3GD20H_GYRO_DEV_NAME },
123	{ L3G4IS_GYRO_DEV_NAME },
124	{ LSM330_GYRO_DEV_NAME },
125	{ LSM9DS0_GYRO_DEV_NAME },
126	{},
127};
128MODULE_DEVICE_TABLE(i2c, st_gyro_id_table);
129
130static struct i2c_driver st_gyro_driver = {
131	.driver = {
132		.name = "st-gyro-i2c",
133		.of_match_table = st_gyro_of_match,
134	},
135	.probe = st_gyro_i2c_probe,
136	.remove = st_gyro_i2c_remove,
137	.id_table = st_gyro_id_table,
138};
139module_i2c_driver(st_gyro_driver);
140
141MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
142MODULE_DESCRIPTION("STMicroelectronics gyroscopes i2c driver");
143MODULE_LICENSE("GPL v2");
144