1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun #include <linux/err.h>
3*4882a593Smuzhiyun #include <linux/i2c.h>
4*4882a593Smuzhiyun #include <linux/i2c-mux.h>
5*4882a593Smuzhiyun #include <linux/iio/iio.h>
6*4882a593Smuzhiyun #include <linux/module.h>
7*4882a593Smuzhiyun #include <linux/regmap.h>
8*4882a593Smuzhiyun #include <linux/pm_runtime.h>
9*4882a593Smuzhiyun
10*4882a593Smuzhiyun #include "mpu3050.h"
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun static const struct regmap_config mpu3050_i2c_regmap_config = {
13*4882a593Smuzhiyun .reg_bits = 8,
14*4882a593Smuzhiyun .val_bits = 8,
15*4882a593Smuzhiyun };
16*4882a593Smuzhiyun
mpu3050_i2c_bypass_select(struct i2c_mux_core * mux,u32 chan_id)17*4882a593Smuzhiyun static int mpu3050_i2c_bypass_select(struct i2c_mux_core *mux, u32 chan_id)
18*4882a593Smuzhiyun {
19*4882a593Smuzhiyun struct mpu3050 *mpu3050 = i2c_mux_priv(mux);
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun /* Just power up the device, that is all that is needed */
22*4882a593Smuzhiyun pm_runtime_get_sync(mpu3050->dev);
23*4882a593Smuzhiyun return 0;
24*4882a593Smuzhiyun }
25*4882a593Smuzhiyun
mpu3050_i2c_bypass_deselect(struct i2c_mux_core * mux,u32 chan_id)26*4882a593Smuzhiyun static int mpu3050_i2c_bypass_deselect(struct i2c_mux_core *mux, u32 chan_id)
27*4882a593Smuzhiyun {
28*4882a593Smuzhiyun struct mpu3050 *mpu3050 = i2c_mux_priv(mux);
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun pm_runtime_mark_last_busy(mpu3050->dev);
31*4882a593Smuzhiyun pm_runtime_put_autosuspend(mpu3050->dev);
32*4882a593Smuzhiyun return 0;
33*4882a593Smuzhiyun }
34*4882a593Smuzhiyun
mpu3050_i2c_probe(struct i2c_client * client,const struct i2c_device_id * id)35*4882a593Smuzhiyun static int mpu3050_i2c_probe(struct i2c_client *client,
36*4882a593Smuzhiyun const struct i2c_device_id *id)
37*4882a593Smuzhiyun {
38*4882a593Smuzhiyun struct regmap *regmap;
39*4882a593Smuzhiyun const char *name;
40*4882a593Smuzhiyun struct mpu3050 *mpu3050;
41*4882a593Smuzhiyun int ret;
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun if (!i2c_check_functionality(client->adapter,
44*4882a593Smuzhiyun I2C_FUNC_SMBUS_I2C_BLOCK))
45*4882a593Smuzhiyun return -EOPNOTSUPP;
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun if (id)
48*4882a593Smuzhiyun name = id->name;
49*4882a593Smuzhiyun else
50*4882a593Smuzhiyun return -ENODEV;
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun regmap = devm_regmap_init_i2c(client, &mpu3050_i2c_regmap_config);
53*4882a593Smuzhiyun if (IS_ERR(regmap)) {
54*4882a593Smuzhiyun dev_err(&client->dev, "Failed to register i2c regmap: %pe\n",
55*4882a593Smuzhiyun regmap);
56*4882a593Smuzhiyun return PTR_ERR(regmap);
57*4882a593Smuzhiyun }
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun ret = mpu3050_common_probe(&client->dev, regmap, client->irq, name);
60*4882a593Smuzhiyun if (ret)
61*4882a593Smuzhiyun return ret;
62*4882a593Smuzhiyun
63*4882a593Smuzhiyun /* The main driver is up, now register the I2C mux */
64*4882a593Smuzhiyun mpu3050 = iio_priv(dev_get_drvdata(&client->dev));
65*4882a593Smuzhiyun mpu3050->i2cmux = i2c_mux_alloc(client->adapter, &client->dev,
66*4882a593Smuzhiyun 1, 0, I2C_MUX_LOCKED | I2C_MUX_GATE,
67*4882a593Smuzhiyun mpu3050_i2c_bypass_select,
68*4882a593Smuzhiyun mpu3050_i2c_bypass_deselect);
69*4882a593Smuzhiyun /* Just fail the mux, there is no point in killing the driver */
70*4882a593Smuzhiyun if (!mpu3050->i2cmux)
71*4882a593Smuzhiyun dev_err(&client->dev, "failed to allocate I2C mux\n");
72*4882a593Smuzhiyun else {
73*4882a593Smuzhiyun mpu3050->i2cmux->priv = mpu3050;
74*4882a593Smuzhiyun /* Ignore failure, not critical */
75*4882a593Smuzhiyun i2c_mux_add_adapter(mpu3050->i2cmux, 0, 0, 0);
76*4882a593Smuzhiyun }
77*4882a593Smuzhiyun
78*4882a593Smuzhiyun return 0;
79*4882a593Smuzhiyun }
80*4882a593Smuzhiyun
mpu3050_i2c_remove(struct i2c_client * client)81*4882a593Smuzhiyun static int mpu3050_i2c_remove(struct i2c_client *client)
82*4882a593Smuzhiyun {
83*4882a593Smuzhiyun struct iio_dev *indio_dev = dev_get_drvdata(&client->dev);
84*4882a593Smuzhiyun struct mpu3050 *mpu3050 = iio_priv(indio_dev);
85*4882a593Smuzhiyun
86*4882a593Smuzhiyun if (mpu3050->i2cmux)
87*4882a593Smuzhiyun i2c_mux_del_adapters(mpu3050->i2cmux);
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun return mpu3050_common_remove(&client->dev);
90*4882a593Smuzhiyun }
91*4882a593Smuzhiyun
92*4882a593Smuzhiyun /*
93*4882a593Smuzhiyun * device id table is used to identify what device can be
94*4882a593Smuzhiyun * supported by this driver
95*4882a593Smuzhiyun */
96*4882a593Smuzhiyun static const struct i2c_device_id mpu3050_i2c_id[] = {
97*4882a593Smuzhiyun { "mpu3050" },
98*4882a593Smuzhiyun {}
99*4882a593Smuzhiyun };
100*4882a593Smuzhiyun MODULE_DEVICE_TABLE(i2c, mpu3050_i2c_id);
101*4882a593Smuzhiyun
102*4882a593Smuzhiyun static const struct of_device_id mpu3050_i2c_of_match[] = {
103*4882a593Smuzhiyun { .compatible = "invensense,mpu3050", .data = "mpu3050" },
104*4882a593Smuzhiyun /* Deprecated vendor ID from the Input driver */
105*4882a593Smuzhiyun { .compatible = "invn,mpu3050", .data = "mpu3050" },
106*4882a593Smuzhiyun { },
107*4882a593Smuzhiyun };
108*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, mpu3050_i2c_of_match);
109*4882a593Smuzhiyun
110*4882a593Smuzhiyun static struct i2c_driver mpu3050_i2c_driver = {
111*4882a593Smuzhiyun .probe = mpu3050_i2c_probe,
112*4882a593Smuzhiyun .remove = mpu3050_i2c_remove,
113*4882a593Smuzhiyun .id_table = mpu3050_i2c_id,
114*4882a593Smuzhiyun .driver = {
115*4882a593Smuzhiyun .of_match_table = mpu3050_i2c_of_match,
116*4882a593Smuzhiyun .name = "mpu3050-i2c",
117*4882a593Smuzhiyun .pm = &mpu3050_dev_pm_ops,
118*4882a593Smuzhiyun },
119*4882a593Smuzhiyun };
120*4882a593Smuzhiyun module_i2c_driver(mpu3050_i2c_driver);
121*4882a593Smuzhiyun
122*4882a593Smuzhiyun MODULE_AUTHOR("Linus Walleij");
123*4882a593Smuzhiyun MODULE_DESCRIPTION("Invensense MPU3050 gyroscope driver");
124*4882a593Smuzhiyun MODULE_LICENSE("GPL");
125