1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Implements I2C interface for VTI CMA300_D0x Accelerometer driver
4 *
5 * Copyright (C) 2010 Texas Instruments
6 * Author: Hemanth V <hemanthv@ti.com>
7 */
8
9 #include <linux/module.h>
10 #include <linux/i2c.h>
11 #include <linux/input/cma3000.h>
12 #include "cma3000_d0x.h"
13
cma3000_i2c_set(struct device * dev,u8 reg,u8 val,char * msg)14 static int cma3000_i2c_set(struct device *dev,
15 u8 reg, u8 val, char *msg)
16 {
17 struct i2c_client *client = to_i2c_client(dev);
18 int ret;
19
20 ret = i2c_smbus_write_byte_data(client, reg, val);
21 if (ret < 0)
22 dev_err(&client->dev,
23 "%s failed (%s, %d)\n", __func__, msg, ret);
24 return ret;
25 }
26
cma3000_i2c_read(struct device * dev,u8 reg,char * msg)27 static int cma3000_i2c_read(struct device *dev, u8 reg, char *msg)
28 {
29 struct i2c_client *client = to_i2c_client(dev);
30 int ret;
31
32 ret = i2c_smbus_read_byte_data(client, reg);
33 if (ret < 0)
34 dev_err(&client->dev,
35 "%s failed (%s, %d)\n", __func__, msg, ret);
36 return ret;
37 }
38
39 static const struct cma3000_bus_ops cma3000_i2c_bops = {
40 .bustype = BUS_I2C,
41 #define CMA3000_BUSI2C (0 << 4)
42 .ctrl_mod = CMA3000_BUSI2C,
43 .read = cma3000_i2c_read,
44 .write = cma3000_i2c_set,
45 };
46
cma3000_i2c_probe(struct i2c_client * client,const struct i2c_device_id * id)47 static int cma3000_i2c_probe(struct i2c_client *client,
48 const struct i2c_device_id *id)
49 {
50 struct cma3000_accl_data *data;
51
52 data = cma3000_init(&client->dev, client->irq, &cma3000_i2c_bops);
53 if (IS_ERR(data))
54 return PTR_ERR(data);
55
56 i2c_set_clientdata(client, data);
57
58 return 0;
59 }
60
cma3000_i2c_remove(struct i2c_client * client)61 static void cma3000_i2c_remove(struct i2c_client *client)
62 {
63 struct cma3000_accl_data *data = i2c_get_clientdata(client);
64
65 cma3000_exit(data);
66 }
67
68 #ifdef CONFIG_PM
cma3000_i2c_suspend(struct device * dev)69 static int cma3000_i2c_suspend(struct device *dev)
70 {
71 struct i2c_client *client = to_i2c_client(dev);
72 struct cma3000_accl_data *data = i2c_get_clientdata(client);
73
74 cma3000_suspend(data);
75
76 return 0;
77 }
78
cma3000_i2c_resume(struct device * dev)79 static int cma3000_i2c_resume(struct device *dev)
80 {
81 struct i2c_client *client = to_i2c_client(dev);
82 struct cma3000_accl_data *data = i2c_get_clientdata(client);
83
84 cma3000_resume(data);
85
86 return 0;
87 }
88
89 static const struct dev_pm_ops cma3000_i2c_pm_ops = {
90 .suspend = cma3000_i2c_suspend,
91 .resume = cma3000_i2c_resume,
92 };
93 #endif
94
95 static const struct i2c_device_id cma3000_i2c_id[] = {
96 { "cma3000_d01", 0 },
97 { },
98 };
99
100 MODULE_DEVICE_TABLE(i2c, cma3000_i2c_id);
101
102 static struct i2c_driver cma3000_i2c_driver = {
103 .probe = cma3000_i2c_probe,
104 .remove = cma3000_i2c_remove,
105 .id_table = cma3000_i2c_id,
106 .driver = {
107 .name = "cma3000_i2c_accl",
108 #ifdef CONFIG_PM
109 .pm = &cma3000_i2c_pm_ops,
110 #endif
111 },
112 };
113
114 module_i2c_driver(cma3000_i2c_driver);
115
116 MODULE_DESCRIPTION("CMA3000-D0x Accelerometer I2C Driver");
117 MODULE_LICENSE("GPL");
118 MODULE_AUTHOR("Hemanth V <hemanthv@ti.com>");
119
