]>
Commit | Line | Data |
---|---|---|
db23e500 LP |
1 | /* |
2 | * Driver for the Diolan DLN-2 USB-I2C adapter | |
3 | * | |
4 | * Copyright (c) 2014 Intel Corporation | |
5 | * | |
6 | * Derived from: | |
7 | * i2c-diolan-u2c.c | |
8 | * Copyright (c) 2010-2011 Ericsson AB | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or | |
11 | * modify it under the terms of the GNU General Public License as | |
12 | * published by the Free Software Foundation, version 2. | |
13 | */ | |
14 | ||
15 | #include <linux/kernel.h> | |
16 | #include <linux/module.h> | |
17 | #include <linux/types.h> | |
18 | #include <linux/slab.h> | |
19 | #include <linux/i2c.h> | |
20 | #include <linux/platform_device.h> | |
21 | #include <linux/mfd/dln2.h> | |
afc34be0 | 22 | #include <linux/acpi.h> |
db23e500 LP |
23 | |
24 | #define DLN2_I2C_MODULE_ID 0x03 | |
25 | #define DLN2_I2C_CMD(cmd) DLN2_CMD(cmd, DLN2_I2C_MODULE_ID) | |
26 | ||
27 | /* I2C commands */ | |
28 | #define DLN2_I2C_GET_PORT_COUNT DLN2_I2C_CMD(0x00) | |
29 | #define DLN2_I2C_ENABLE DLN2_I2C_CMD(0x01) | |
30 | #define DLN2_I2C_DISABLE DLN2_I2C_CMD(0x02) | |
31 | #define DLN2_I2C_IS_ENABLED DLN2_I2C_CMD(0x03) | |
32 | #define DLN2_I2C_WRITE DLN2_I2C_CMD(0x06) | |
33 | #define DLN2_I2C_READ DLN2_I2C_CMD(0x07) | |
34 | #define DLN2_I2C_SCAN_DEVICES DLN2_I2C_CMD(0x08) | |
35 | #define DLN2_I2C_PULLUP_ENABLE DLN2_I2C_CMD(0x09) | |
36 | #define DLN2_I2C_PULLUP_DISABLE DLN2_I2C_CMD(0x0A) | |
37 | #define DLN2_I2C_PULLUP_IS_ENABLED DLN2_I2C_CMD(0x0B) | |
38 | #define DLN2_I2C_TRANSFER DLN2_I2C_CMD(0x0C) | |
39 | #define DLN2_I2C_SET_MAX_REPLY_COUNT DLN2_I2C_CMD(0x0D) | |
40 | #define DLN2_I2C_GET_MAX_REPLY_COUNT DLN2_I2C_CMD(0x0E) | |
41 | ||
42 | #define DLN2_I2C_MAX_XFER_SIZE 256 | |
43 | #define DLN2_I2C_BUF_SIZE (DLN2_I2C_MAX_XFER_SIZE + 16) | |
44 | ||
45 | struct dln2_i2c { | |
46 | struct platform_device *pdev; | |
47 | struct i2c_adapter adapter; | |
48 | u8 port; | |
49 | /* | |
50 | * Buffer to hold the packet for read or write transfers. One is enough | |
51 | * since we can't have multiple transfers in parallel on the i2c bus. | |
52 | */ | |
53 | void *buf; | |
54 | }; | |
55 | ||
56 | static int dln2_i2c_enable(struct dln2_i2c *dln2, bool enable) | |
57 | { | |
db23e500 LP |
58 | u16 cmd; |
59 | struct { | |
60 | u8 port; | |
61 | } tx; | |
62 | ||
63 | tx.port = dln2->port; | |
64 | ||
65 | if (enable) | |
66 | cmd = DLN2_I2C_ENABLE; | |
67 | else | |
68 | cmd = DLN2_I2C_DISABLE; | |
69 | ||
93316428 | 70 | return dln2_transfer_tx(dln2->pdev, cmd, &tx, sizeof(tx)); |
db23e500 LP |
71 | } |
72 | ||
73 | static int dln2_i2c_write(struct dln2_i2c *dln2, u8 addr, | |
74 | u8 *data, u16 data_len) | |
75 | { | |
76 | int ret; | |
77 | struct { | |
78 | u8 port; | |
79 | u8 addr; | |
80 | u8 mem_addr_len; | |
81 | __le32 mem_addr; | |
82 | __le16 buf_len; | |
83 | u8 buf[DLN2_I2C_MAX_XFER_SIZE]; | |
84 | } __packed *tx = dln2->buf; | |
85 | unsigned len; | |
86 | ||
87 | BUILD_BUG_ON(sizeof(*tx) > DLN2_I2C_BUF_SIZE); | |
88 | ||
89 | tx->port = dln2->port; | |
90 | tx->addr = addr; | |
91 | tx->mem_addr_len = 0; | |
92 | tx->mem_addr = 0; | |
93 | tx->buf_len = cpu_to_le16(data_len); | |
94 | memcpy(tx->buf, data, data_len); | |
95 | ||
96 | len = sizeof(*tx) + data_len - DLN2_I2C_MAX_XFER_SIZE; | |
97 | ret = dln2_transfer_tx(dln2->pdev, DLN2_I2C_WRITE, tx, len); | |
98 | if (ret < 0) | |
99 | return ret; | |
100 | ||
101 | return data_len; | |
102 | } | |
103 | ||
104 | static int dln2_i2c_read(struct dln2_i2c *dln2, u16 addr, u8 *data, | |
105 | u16 data_len) | |
106 | { | |
107 | int ret; | |
108 | struct { | |
109 | u8 port; | |
110 | u8 addr; | |
111 | u8 mem_addr_len; | |
112 | __le32 mem_addr; | |
113 | __le16 buf_len; | |
114 | } __packed tx; | |
115 | struct { | |
116 | __le16 buf_len; | |
117 | u8 buf[DLN2_I2C_MAX_XFER_SIZE]; | |
118 | } __packed *rx = dln2->buf; | |
119 | unsigned rx_len = sizeof(*rx); | |
120 | ||
121 | BUILD_BUG_ON(sizeof(*rx) > DLN2_I2C_BUF_SIZE); | |
122 | ||
123 | tx.port = dln2->port; | |
124 | tx.addr = addr; | |
125 | tx.mem_addr_len = 0; | |
126 | tx.mem_addr = 0; | |
127 | tx.buf_len = cpu_to_le16(data_len); | |
128 | ||
129 | ret = dln2_transfer(dln2->pdev, DLN2_I2C_READ, &tx, sizeof(tx), | |
130 | rx, &rx_len); | |
131 | if (ret < 0) | |
132 | return ret; | |
133 | if (rx_len < sizeof(rx->buf_len) + data_len) | |
134 | return -EPROTO; | |
135 | if (le16_to_cpu(rx->buf_len) != data_len) | |
136 | return -EPROTO; | |
137 | ||
138 | memcpy(data, rx->buf, data_len); | |
139 | ||
140 | return data_len; | |
141 | } | |
142 | ||
143 | static int dln2_i2c_xfer(struct i2c_adapter *adapter, | |
144 | struct i2c_msg *msgs, int num) | |
145 | { | |
146 | struct dln2_i2c *dln2 = i2c_get_adapdata(adapter); | |
147 | struct i2c_msg *pmsg; | |
db23e500 LP |
148 | int i; |
149 | ||
150 | for (i = 0; i < num; i++) { | |
151 | int ret; | |
152 | ||
153 | pmsg = &msgs[i]; | |
154 | ||
db23e500 LP |
155 | if (pmsg->flags & I2C_M_RD) { |
156 | ret = dln2_i2c_read(dln2, pmsg->addr, pmsg->buf, | |
157 | pmsg->len); | |
158 | if (ret < 0) | |
159 | return ret; | |
160 | ||
161 | pmsg->len = ret; | |
162 | } else { | |
163 | ret = dln2_i2c_write(dln2, pmsg->addr, pmsg->buf, | |
164 | pmsg->len); | |
165 | if (ret != pmsg->len) | |
166 | return -EPROTO; | |
167 | } | |
168 | } | |
169 | ||
170 | return num; | |
171 | } | |
172 | ||
173 | static u32 dln2_i2c_func(struct i2c_adapter *a) | |
174 | { | |
175 | return I2C_FUNC_I2C | I2C_FUNC_SMBUS_BYTE | I2C_FUNC_SMBUS_BYTE_DATA | | |
176 | I2C_FUNC_SMBUS_WORD_DATA | I2C_FUNC_SMBUS_BLOCK_PROC_CALL | | |
177 | I2C_FUNC_SMBUS_I2C_BLOCK; | |
178 | } | |
179 | ||
180 | static const struct i2c_algorithm dln2_i2c_usb_algorithm = { | |
181 | .master_xfer = dln2_i2c_xfer, | |
182 | .functionality = dln2_i2c_func, | |
183 | }; | |
184 | ||
379883cc | 185 | static const struct i2c_adapter_quirks dln2_i2c_quirks = { |
afe90203 WS |
186 | .max_read_len = DLN2_I2C_MAX_XFER_SIZE, |
187 | .max_write_len = DLN2_I2C_MAX_XFER_SIZE, | |
188 | }; | |
189 | ||
db23e500 LP |
190 | static int dln2_i2c_probe(struct platform_device *pdev) |
191 | { | |
192 | int ret; | |
193 | struct dln2_i2c *dln2; | |
194 | struct device *dev = &pdev->dev; | |
195 | struct dln2_platform_data *pdata = dev_get_platdata(&pdev->dev); | |
196 | ||
197 | dln2 = devm_kzalloc(dev, sizeof(*dln2), GFP_KERNEL); | |
198 | if (!dln2) | |
199 | return -ENOMEM; | |
200 | ||
201 | dln2->buf = devm_kmalloc(dev, DLN2_I2C_BUF_SIZE, GFP_KERNEL); | |
202 | if (!dln2->buf) | |
203 | return -ENOMEM; | |
204 | ||
205 | dln2->pdev = pdev; | |
206 | dln2->port = pdata->port; | |
207 | ||
208 | /* setup i2c adapter description */ | |
209 | dln2->adapter.owner = THIS_MODULE; | |
210 | dln2->adapter.class = I2C_CLASS_HWMON; | |
211 | dln2->adapter.algo = &dln2_i2c_usb_algorithm; | |
afe90203 | 212 | dln2->adapter.quirks = &dln2_i2c_quirks; |
db23e500 | 213 | dln2->adapter.dev.parent = dev; |
afc34be0 | 214 | ACPI_COMPANION_SET(&dln2->adapter.dev, ACPI_COMPANION(&pdev->dev)); |
3b10db23 | 215 | dln2->adapter.dev.of_node = dev->of_node; |
db23e500 LP |
216 | i2c_set_adapdata(&dln2->adapter, dln2); |
217 | snprintf(dln2->adapter.name, sizeof(dln2->adapter.name), "%s-%s-%d", | |
218 | "dln2-i2c", dev_name(pdev->dev.parent), dln2->port); | |
219 | ||
220 | platform_set_drvdata(pdev, dln2); | |
221 | ||
222 | /* initialize the i2c interface */ | |
223 | ret = dln2_i2c_enable(dln2, true); | |
224 | if (ret < 0) { | |
225 | dev_err(dev, "failed to initialize adapter: %d\n", ret); | |
226 | return ret; | |
227 | } | |
228 | ||
229 | /* and finally attach to i2c layer */ | |
230 | ret = i2c_add_adapter(&dln2->adapter); | |
ea734404 | 231 | if (ret < 0) |
db23e500 | 232 | goto out_disable; |
db23e500 LP |
233 | |
234 | return 0; | |
235 | ||
236 | out_disable: | |
237 | dln2_i2c_enable(dln2, false); | |
238 | ||
239 | return ret; | |
240 | } | |
241 | ||
242 | static int dln2_i2c_remove(struct platform_device *pdev) | |
243 | { | |
244 | struct dln2_i2c *dln2 = platform_get_drvdata(pdev); | |
245 | ||
246 | i2c_del_adapter(&dln2->adapter); | |
247 | dln2_i2c_enable(dln2, false); | |
248 | ||
249 | return 0; | |
250 | } | |
251 | ||
252 | static struct platform_driver dln2_i2c_driver = { | |
253 | .driver.name = "dln2-i2c", | |
254 | .probe = dln2_i2c_probe, | |
255 | .remove = dln2_i2c_remove, | |
256 | }; | |
257 | ||
258 | module_platform_driver(dln2_i2c_driver); | |
259 | ||
260 | MODULE_AUTHOR("Laurentiu Palcu <laurentiu.palcu@intel.com>"); | |
261 | MODULE_DESCRIPTION("Driver for the Diolan DLN2 I2C master interface"); | |
262 | MODULE_LICENSE("GPL v2"); | |
263 | MODULE_ALIAS("platform:dln2-i2c"); |