1
2
3
4
5
6
7
8
9
10
11#include <linux/kernel.h>
12#include <linux/module.h>
13#include <linux/i2c.h>
14#include <linux/slab.h>
15#include <linux/regmap.h>
16
17#include "st_lsm6dsx.h"
18
19static const struct regmap_config st_lsm6dsx_i2c_regmap_config = {
20 .reg_bits = 8,
21 .val_bits = 8,
22};
23
24static int st_lsm6dsx_i2c_probe(struct i2c_client *client,
25 const struct i2c_device_id *id)
26{
27 int hw_id = id->driver_data;
28 struct regmap *regmap;
29
30 regmap = devm_regmap_init_i2c(client, &st_lsm6dsx_i2c_regmap_config);
31 if (IS_ERR(regmap)) {
32 dev_err(&client->dev, "Failed to register i2c regmap %d\n",
33 (int)PTR_ERR(regmap));
34 return PTR_ERR(regmap);
35 }
36
37 return st_lsm6dsx_probe(&client->dev, client->irq, hw_id, regmap);
38}
39
40static const struct of_device_id st_lsm6dsx_i2c_of_match[] = {
41 {
42 .compatible = "st,lsm6ds3",
43 .data = (void *)ST_LSM6DS3_ID,
44 },
45 {
46 .compatible = "st,lsm6ds3h",
47 .data = (void *)ST_LSM6DS3H_ID,
48 },
49 {
50 .compatible = "st,lsm6dsl",
51 .data = (void *)ST_LSM6DSL_ID,
52 },
53 {
54 .compatible = "st,lsm6dsm",
55 .data = (void *)ST_LSM6DSM_ID,
56 },
57 {
58 .compatible = "st,ism330dlc",
59 .data = (void *)ST_ISM330DLC_ID,
60 },
61 {
62 .compatible = "st,lsm6dso",
63 .data = (void *)ST_LSM6DSO_ID,
64 },
65 {
66 .compatible = "st,asm330lhh",
67 .data = (void *)ST_ASM330LHH_ID,
68 },
69 {
70 .compatible = "st,lsm6dsox",
71 .data = (void *)ST_LSM6DSOX_ID,
72 },
73 {
74 .compatible = "st,lsm6dsr",
75 .data = (void *)ST_LSM6DSR_ID,
76 },
77 {
78 .compatible = "st,lsm6ds3tr-c",
79 .data = (void *)ST_LSM6DS3TRC_ID,
80 },
81 {
82 .compatible = "st,ism330dhcx",
83 .data = (void *)ST_ISM330DHCX_ID,
84 },
85 {
86 .compatible = "st,lsm9ds1-imu",
87 .data = (void *)ST_LSM9DS1_ID,
88 },
89 {
90 .compatible = "st,lsm6ds0",
91 .data = (void *)ST_LSM6DS0_ID,
92 },
93 {
94 .compatible = "st,lsm6dsrx",
95 .data = (void *)ST_LSM6DSRX_ID,
96 },
97 {},
98};
99MODULE_DEVICE_TABLE(of, st_lsm6dsx_i2c_of_match);
100
101static const struct i2c_device_id st_lsm6dsx_i2c_id_table[] = {
102 { ST_LSM6DS3_DEV_NAME, ST_LSM6DS3_ID },
103 { ST_LSM6DS3H_DEV_NAME, ST_LSM6DS3H_ID },
104 { ST_LSM6DSL_DEV_NAME, ST_LSM6DSL_ID },
105 { ST_LSM6DSM_DEV_NAME, ST_LSM6DSM_ID },
106 { ST_ISM330DLC_DEV_NAME, ST_ISM330DLC_ID },
107 { ST_LSM6DSO_DEV_NAME, ST_LSM6DSO_ID },
108 { ST_ASM330LHH_DEV_NAME, ST_ASM330LHH_ID },
109 { ST_LSM6DSOX_DEV_NAME, ST_LSM6DSOX_ID },
110 { ST_LSM6DSR_DEV_NAME, ST_LSM6DSR_ID },
111 { ST_LSM6DS3TRC_DEV_NAME, ST_LSM6DS3TRC_ID },
112 { ST_ISM330DHCX_DEV_NAME, ST_ISM330DHCX_ID },
113 { ST_LSM9DS1_DEV_NAME, ST_LSM9DS1_ID },
114 { ST_LSM6DS0_DEV_NAME, ST_LSM6DS0_ID },
115 { ST_LSM6DSRX_DEV_NAME, ST_LSM6DSRX_ID },
116 {},
117};
118MODULE_DEVICE_TABLE(i2c, st_lsm6dsx_i2c_id_table);
119
120static struct i2c_driver st_lsm6dsx_driver = {
121 .driver = {
122 .name = "st_lsm6dsx_i2c",
123 .pm = &st_lsm6dsx_pm_ops,
124 .of_match_table = st_lsm6dsx_i2c_of_match,
125 },
126 .probe = st_lsm6dsx_i2c_probe,
127 .id_table = st_lsm6dsx_i2c_id_table,
128};
129module_i2c_driver(st_lsm6dsx_driver);
130
131MODULE_AUTHOR("Lorenzo Bianconi <lorenzo.bianconi@st.com>");
132MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
133MODULE_DESCRIPTION("STMicroelectronics st_lsm6dsx i2c driver");
134MODULE_LICENSE("GPL v2");
135