[go: nahoru, domu]

1/*
2 * STMicroelectronics pressures driver
3 *
4 * Copyright 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_pressure.h"
20
21#ifdef CONFIG_OF
22static const struct of_device_id st_press_of_match[] = {
23	{
24		.compatible = "st,lps001wp-press",
25		.data = LPS001WP_PRESS_DEV_NAME,
26	},
27	{
28		.compatible = "st,lps25h-press",
29		.data = LPS25H_PRESS_DEV_NAME,
30	},
31	{
32		.compatible = "st,lps331ap-press",
33		.data = LPS331AP_PRESS_DEV_NAME,
34	},
35	{},
36};
37MODULE_DEVICE_TABLE(of, st_press_of_match);
38#else
39#define st_press_of_match NULL
40#endif
41
42static int st_press_i2c_probe(struct i2c_client *client,
43						const struct i2c_device_id *id)
44{
45	struct iio_dev *indio_dev;
46	struct st_sensor_data *pdata;
47	int err;
48
49	indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*pdata));
50	if (!indio_dev)
51		return -ENOMEM;
52
53	pdata = iio_priv(indio_dev);
54	pdata->dev = &client->dev;
55	st_sensors_of_i2c_probe(client, st_press_of_match);
56
57	st_sensors_i2c_configure(indio_dev, client, pdata);
58
59	err = st_press_common_probe(indio_dev, client->dev.platform_data);
60	if (err < 0)
61		return err;
62
63	return 0;
64}
65
66static int st_press_i2c_remove(struct i2c_client *client)
67{
68	st_press_common_remove(i2c_get_clientdata(client));
69
70	return 0;
71}
72
73static const struct i2c_device_id st_press_id_table[] = {
74	{ LPS001WP_PRESS_DEV_NAME },
75	{ LPS25H_PRESS_DEV_NAME },
76	{ LPS331AP_PRESS_DEV_NAME },
77	{},
78};
79MODULE_DEVICE_TABLE(i2c, st_press_id_table);
80
81static struct i2c_driver st_press_driver = {
82	.driver = {
83		.owner = THIS_MODULE,
84		.name = "st-press-i2c",
85		.of_match_table = of_match_ptr(st_press_of_match),
86	},
87	.probe = st_press_i2c_probe,
88	.remove = st_press_i2c_remove,
89	.id_table = st_press_id_table,
90};
91module_i2c_driver(st_press_driver);
92
93MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
94MODULE_DESCRIPTION("STMicroelectronics pressures i2c driver");
95MODULE_LICENSE("GPL v2");
96