1
2
3
4
5
6
7
8
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