1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * ADLX345/346 Three-Axis Digital Accelerometers (I2C Interface)
4 *
5 * Enter bugs at http://blackfin.uclinux.org/
6 *
7 * Copyright (C) 2009 Michael Hennerich, Analog Devices Inc.
8 */
9
10 #include <linux/input.h> /* BUS_I2C */
11 #include <linux/i2c.h>
12 #include <linux/module.h>
13 #include <linux/of.h>
14 #include <linux/types.h>
15 #include <linux/pm.h>
16 #include "adxl34x.h"
17
adxl34x_smbus_read(struct device * dev,unsigned char reg)18 static int adxl34x_smbus_read(struct device *dev, unsigned char reg)
19 {
20 struct i2c_client *client = to_i2c_client(dev);
21
22 return i2c_smbus_read_byte_data(client, reg);
23 }
24
adxl34x_smbus_write(struct device * dev,unsigned char reg,unsigned char val)25 static int adxl34x_smbus_write(struct device *dev,
26 unsigned char reg, unsigned char val)
27 {
28 struct i2c_client *client = to_i2c_client(dev);
29
30 return i2c_smbus_write_byte_data(client, reg, val);
31 }
32
adxl34x_smbus_read_block(struct device * dev,unsigned char reg,int count,void * buf)33 static int adxl34x_smbus_read_block(struct device *dev,
34 unsigned char reg, int count,
35 void *buf)
36 {
37 struct i2c_client *client = to_i2c_client(dev);
38
39 return i2c_smbus_read_i2c_block_data(client, reg, count, buf);
40 }
41
adxl34x_i2c_read_block(struct device * dev,unsigned char reg,int count,void * buf)42 static int adxl34x_i2c_read_block(struct device *dev,
43 unsigned char reg, int count,
44 void *buf)
45 {
46 struct i2c_client *client = to_i2c_client(dev);
47 int ret;
48
49 ret = i2c_master_send(client, ®, 1);
50 if (ret < 0)
51 return ret;
52
53 ret = i2c_master_recv(client, buf, count);
54 if (ret < 0)
55 return ret;
56
57 if (ret != count)
58 return -EIO;
59
60 return 0;
61 }
62
63 static const struct adxl34x_bus_ops adxl34x_smbus_bops = {
64 .bustype = BUS_I2C,
65 .write = adxl34x_smbus_write,
66 .read = adxl34x_smbus_read,
67 .read_block = adxl34x_smbus_read_block,
68 };
69
70 static const struct adxl34x_bus_ops adxl34x_i2c_bops = {
71 .bustype = BUS_I2C,
72 .write = adxl34x_smbus_write,
73 .read = adxl34x_smbus_read,
74 .read_block = adxl34x_i2c_read_block,
75 };
76
adxl34x_i2c_probe(struct i2c_client * client,const struct i2c_device_id * id)77 static int adxl34x_i2c_probe(struct i2c_client *client,
78 const struct i2c_device_id *id)
79 {
80 struct adxl34x *ac;
81 int error;
82
83 error = i2c_check_functionality(client->adapter,
84 I2C_FUNC_SMBUS_BYTE_DATA);
85 if (!error) {
86 dev_err(&client->dev, "SMBUS Byte Data not Supported\n");
87 return -EIO;
88 }
89
90 ac = adxl34x_probe(&client->dev, client->irq, false,
91 i2c_check_functionality(client->adapter,
92 I2C_FUNC_SMBUS_READ_I2C_BLOCK) ?
93 &adxl34x_smbus_bops : &adxl34x_i2c_bops);
94 if (IS_ERR(ac))
95 return PTR_ERR(ac);
96
97 i2c_set_clientdata(client, ac);
98
99 return 0;
100 }
101
adxl34x_i2c_remove(struct i2c_client * client)102 static void adxl34x_i2c_remove(struct i2c_client *client)
103 {
104 struct adxl34x *ac = i2c_get_clientdata(client);
105
106 adxl34x_remove(ac);
107 }
108
adxl34x_i2c_suspend(struct device * dev)109 static int __maybe_unused adxl34x_i2c_suspend(struct device *dev)
110 {
111 struct i2c_client *client = to_i2c_client(dev);
112 struct adxl34x *ac = i2c_get_clientdata(client);
113
114 adxl34x_suspend(ac);
115
116 return 0;
117 }
118
adxl34x_i2c_resume(struct device * dev)119 static int __maybe_unused adxl34x_i2c_resume(struct device *dev)
120 {
121 struct i2c_client *client = to_i2c_client(dev);
122 struct adxl34x *ac = i2c_get_clientdata(client);
123
124 adxl34x_resume(ac);
125
126 return 0;
127 }
128
129 static SIMPLE_DEV_PM_OPS(adxl34x_i2c_pm, adxl34x_i2c_suspend,
130 adxl34x_i2c_resume);
131
132 static const struct i2c_device_id adxl34x_id[] = {
133 { "adxl34x", 0 },
134 { }
135 };
136
137 MODULE_DEVICE_TABLE(i2c, adxl34x_id);
138
139 static const struct of_device_id adxl34x_of_id[] = {
140 /*
141 * The ADXL346 is backward-compatible with the ADXL345. Differences are
142 * handled by runtime detection of the device model, there's thus no
143 * need for listing the "adi,adxl346" compatible value explicitly.
144 */
145 { .compatible = "adi,adxl345", },
146 /*
147 * Deprecated, DT nodes should use one or more of the device-specific
148 * compatible values "adi,adxl345" and "adi,adxl346".
149 */
150 { .compatible = "adi,adxl34x", },
151 { }
152 };
153
154 MODULE_DEVICE_TABLE(of, adxl34x_of_id);
155
156 static struct i2c_driver adxl34x_driver = {
157 .driver = {
158 .name = "adxl34x",
159 .pm = &adxl34x_i2c_pm,
160 .of_match_table = adxl34x_of_id,
161 },
162 .probe = adxl34x_i2c_probe,
163 .remove = adxl34x_i2c_remove,
164 .id_table = adxl34x_id,
165 };
166
167 module_i2c_driver(adxl34x_driver);
168
169 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
170 MODULE_DESCRIPTION("ADXL345/346 Three-Axis Digital Accelerometer I2C Bus Driver");
171 MODULE_LICENSE("GPL");
172