1/*
2 * STMicroelectronics gyroscopes driver
3 *
4 * Copyright 2012-2013 STMicroelectronics Inc.
5 *
6 * Denis Ciocca <denis.ciocca@st.com>
7 *
8 * Licensed under the GPL-2.
9 */
10
11#include <linux/kernel.h>
12#include <linux/module.h>
13#include <linux/slab.h>
14#include <linux/i2c.h>
15#include <linux/iio/iio.h>
16
17#include <linux/iio/common/st_sensors.h>
18#include <linux/iio/common/st_sensors_i2c.h>
19#include "st_gyro.h"
20
21#ifdef CONFIG_OF
22static const struct of_device_id st_gyro_of_match[] = {
23	{
24		.compatible = "st,l3g4200d-gyro",
25		.data = L3G4200D_GYRO_DEV_NAME,
26	},
27	{
28		.compatible = "st,lsm330d-gyro",
29		.data = LSM330D_GYRO_DEV_NAME,
30	},
31	{
32		.compatible = "st,lsm330dl-gyro",
33		.data = LSM330DL_GYRO_DEV_NAME,
34	},
35	{
36		.compatible = "st,lsm330dlc-gyro",
37		.data = LSM330DLC_GYRO_DEV_NAME,
38	},
39	{
40		.compatible = "st,l3gd20-gyro",
41		.data = L3GD20_GYRO_DEV_NAME,
42	},
43	{
44		.compatible = "st,l3g4is-gyro",
45		.data = L3G4IS_GYRO_DEV_NAME,
46	},
47	{
48		.compatible = "st,lsm330-gyro",
49		.data = LSM330_GYRO_DEV_NAME,
50	},
51	{},
52};
53MODULE_DEVICE_TABLE(of, st_gyro_of_match);
54#else
55#define st_gyro_of_match NULL
56#endif
57
58static int st_gyro_i2c_probe(struct i2c_client *client,
59						const struct i2c_device_id *id)
60{
61	struct iio_dev *indio_dev;
62	struct st_sensor_data *gdata;
63	int err;
64
65	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*gdata));
66	if (!indio_dev)
67		return -ENOMEM;
68
69	gdata = iio_priv(indio_dev);
70	st_sensors_of_i2c_probe(client, st_gyro_of_match);
71
72	st_sensors_i2c_configure(indio_dev, client, gdata);
73
74	err = st_gyro_common_probe(indio_dev);
75	if (err < 0)
76		return err;
77
78	return 0;
79}
80
81static int st_gyro_i2c_remove(struct i2c_client *client)
82{
83	st_gyro_common_remove(i2c_get_clientdata(client));
84
85	return 0;
86}
87
88static const struct i2c_device_id st_gyro_id_table[] = {
89	{ L3G4200D_GYRO_DEV_NAME },
90	{ LSM330D_GYRO_DEV_NAME },
91	{ LSM330DL_GYRO_DEV_NAME },
92	{ LSM330DLC_GYRO_DEV_NAME },
93	{ L3GD20_GYRO_DEV_NAME },
94	{ L3G4IS_GYRO_DEV_NAME },
95	{ LSM330_GYRO_DEV_NAME },
96	{},
97};
98MODULE_DEVICE_TABLE(i2c, st_gyro_id_table);
99
100static struct i2c_driver st_gyro_driver = {
101	.driver = {
102		.name = "st-gyro-i2c",
103		.of_match_table = of_match_ptr(st_gyro_of_match),
104	},
105	.probe = st_gyro_i2c_probe,
106	.remove = st_gyro_i2c_remove,
107	.id_table = st_gyro_id_table,
108};
109module_i2c_driver(st_gyro_driver);
110
111MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
112MODULE_DESCRIPTION("STMicroelectronics gyroscopes i2c driver");
113MODULE_LICENSE("GPL v2");
114