1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/clk.h>
16#include <linux/errno.h>
17#include <linux/i2c.h>
18#include <linux/interrupt.h>
19#include <linux/io.h>
20#include <linux/kernel.h>
21#include <linux/module.h>
22#include <linux/of.h>
23#include <linux/of_device.h>
24#include <linux/platform_device.h>
25#include <linux/sched.h>
26#include <linux/time.h>
27
28
29#define LPC24XX_I2CONSET 0x00
30#define LPC24XX_I2STAT 0x04
31#define LPC24XX_I2DAT 0x08
32#define LPC24XX_I2ADDR 0x0c
33#define LPC24XX_I2SCLH 0x10
34#define LPC24XX_I2SCLL 0x14
35#define LPC24XX_I2CONCLR 0x18
36
37#define LPC24XX_AA BIT(2)
38#define LPC24XX_SI BIT(3)
39#define LPC24XX_STO BIT(4)
40#define LPC24XX_STA BIT(5)
41#define LPC24XX_I2EN BIT(6)
42
43#define LPC24XX_STO_AA (LPC24XX_STO | LPC24XX_AA)
44#define LPC24XX_CLEAR_ALL (LPC24XX_AA | LPC24XX_SI | LPC24XX_STO | \
45 LPC24XX_STA | LPC24XX_I2EN)
46
47
48#define I2C_STD_MODE_DUTY 46
49#define I2C_FAST_MODE_DUTY 36
50#define I2C_FAST_MODE_PLUS_DUTY 38
51
52
53
54
55
56enum {
57 M_BUS_ERROR = 0x00,
58 M_START = 0x08,
59 M_REPSTART = 0x10,
60 MX_ADDR_W_ACK = 0x18,
61 MX_ADDR_W_NACK = 0x20,
62 MX_DATA_W_ACK = 0x28,
63 MX_DATA_W_NACK = 0x30,
64 M_DATA_ARB_LOST = 0x38,
65 MR_ADDR_R_ACK = 0x40,
66 MR_ADDR_R_NACK = 0x48,
67 MR_DATA_R_ACK = 0x50,
68 MR_DATA_R_NACK = 0x58,
69 M_I2C_IDLE = 0xf8,
70};
71
72struct lpc2k_i2c {
73 void __iomem *base;
74 struct clk *clk;
75 int irq;
76 wait_queue_head_t wait;
77 struct i2c_adapter adap;
78 struct i2c_msg *msg;
79 int msg_idx;
80 int msg_status;
81 int is_last;
82};
83
84static void i2c_lpc2k_reset(struct lpc2k_i2c *i2c)
85{
86
87 writel(LPC24XX_CLEAR_ALL, i2c->base + LPC24XX_I2CONCLR);
88 writel(0, i2c->base + LPC24XX_I2ADDR);
89 writel(LPC24XX_I2EN, i2c->base + LPC24XX_I2CONSET);
90}
91
92static int i2c_lpc2k_clear_arb(struct lpc2k_i2c *i2c)
93{
94 unsigned long timeout = jiffies + msecs_to_jiffies(1000);
95
96
97
98
99
100 writel(LPC24XX_STO, i2c->base + LPC24XX_I2CONSET);
101
102
103 while (readl(i2c->base + LPC24XX_I2STAT) != M_I2C_IDLE) {
104 if (time_after(jiffies, timeout)) {
105
106 i2c_lpc2k_reset(i2c);
107 return -EBUSY;
108 }
109
110 cpu_relax();
111 }
112
113 return 0;
114}
115
116static void i2c_lpc2k_pump_msg(struct lpc2k_i2c *i2c)
117{
118 unsigned char data;
119 u32 status;
120
121
122
123
124
125 status = readl(i2c->base + LPC24XX_I2STAT);
126
127 switch (status) {
128 case M_START:
129 case M_REPSTART:
130
131 data = i2c_8bit_addr_from_msg(i2c->msg);
132
133 writel(data, i2c->base + LPC24XX_I2DAT);
134 writel(LPC24XX_STA, i2c->base + LPC24XX_I2CONCLR);
135 break;
136
137 case MX_ADDR_W_ACK:
138 case MX_DATA_W_ACK:
139
140
141
142
143 if (i2c->msg_idx < i2c->msg->len) {
144 writel(i2c->msg->buf[i2c->msg_idx],
145 i2c->base + LPC24XX_I2DAT);
146 } else if (i2c->is_last) {
147
148 writel(LPC24XX_STO_AA, i2c->base + LPC24XX_I2CONSET);
149 writel(LPC24XX_SI, i2c->base + LPC24XX_I2CONCLR);
150 i2c->msg_status = 0;
151 disable_irq_nosync(i2c->irq);
152 } else {
153 i2c->msg_status = 0;
154 disable_irq_nosync(i2c->irq);
155 }
156
157 i2c->msg_idx++;
158 break;
159
160 case MR_ADDR_R_ACK:
161
162 if (i2c->msg->len == 1) {
163
164 writel(LPC24XX_AA, i2c->base + LPC24XX_I2CONCLR);
165 } else {
166
167 writel(LPC24XX_AA, i2c->base + LPC24XX_I2CONSET);
168 }
169
170 writel(LPC24XX_STA, i2c->base + LPC24XX_I2CONCLR);
171 break;
172
173 case MR_DATA_R_NACK:
174
175
176
177
178
179 case MR_DATA_R_ACK:
180
181 if (i2c->msg_idx < i2c->msg->len) {
182 i2c->msg->buf[i2c->msg_idx] =
183 readl(i2c->base + LPC24XX_I2DAT);
184 }
185
186
187 if (i2c->msg_idx >= i2c->msg->len - 1 && i2c->is_last) {
188 writel(LPC24XX_STO_AA, i2c->base + LPC24XX_I2CONSET);
189 writel(LPC24XX_SI, i2c->base + LPC24XX_I2CONCLR);
190 i2c->msg_status = 0;
191 }
192
193
194 if (i2c->msg_idx >= i2c->msg->len - 1) {
195 i2c->msg_status = 0;
196 disable_irq_nosync(i2c->irq);
197 }
198
199
200
201
202
203 if (i2c->msg_idx >= i2c->msg->len - 2) {
204
205 writel(LPC24XX_AA, i2c->base + LPC24XX_I2CONCLR);
206 } else {
207
208 writel(LPC24XX_AA, i2c->base + LPC24XX_I2CONSET);
209 }
210
211 writel(LPC24XX_STA, i2c->base + LPC24XX_I2CONCLR);
212 i2c->msg_idx++;
213 break;
214
215 case MX_ADDR_W_NACK:
216 case MX_DATA_W_NACK:
217 case MR_ADDR_R_NACK:
218
219 writel(LPC24XX_STO_AA, i2c->base + LPC24XX_I2CONSET);
220 i2c->msg_status = -ENXIO;
221 disable_irq_nosync(i2c->irq);
222 break;
223
224 case M_DATA_ARB_LOST:
225
226 i2c->msg_status = -EAGAIN;
227
228
229 writel(LPC24XX_STA | LPC24XX_STO, i2c->base + LPC24XX_I2CONCLR);
230 disable_irq_nosync(i2c->irq);
231 break;
232
233 default:
234
235 i2c->msg_status = -EIO;
236 disable_irq_nosync(i2c->irq);
237 break;
238 }
239
240
241 if (i2c->msg_status != -EBUSY)
242 wake_up(&i2c->wait);
243
244
245
246
247
248 if (i2c->msg_status != 0)
249 writel(LPC24XX_SI, i2c->base + LPC24XX_I2CONCLR);
250}
251
252static int lpc2k_process_msg(struct lpc2k_i2c *i2c, int msgidx)
253{
254
255 if (!msgidx) {
256 writel(LPC24XX_STA, i2c->base + LPC24XX_I2CONSET);
257 } else {
258
259
260
261
262
263 if (unlikely(i2c->msg->flags & I2C_M_NOSTART)) {
264 WARN_ON(i2c->msg->len == 0);
265
266 if (!(i2c->msg->flags & I2C_M_RD)) {
267
268 writel(i2c->msg->buf[0],
269 i2c->base + LPC24XX_I2DAT);
270 i2c->msg_idx++;
271 }
272 } else {
273
274 writel(LPC24XX_STA, i2c->base + LPC24XX_I2CONSET);
275 }
276
277 writel(LPC24XX_SI, i2c->base + LPC24XX_I2CONCLR);
278 }
279
280 enable_irq(i2c->irq);
281
282
283 if (wait_event_timeout(i2c->wait, i2c->msg_status != -EBUSY,
284 msecs_to_jiffies(1000)) == 0) {
285 disable_irq_nosync(i2c->irq);
286
287 return -ETIMEDOUT;
288 }
289
290 return i2c->msg_status;
291}
292
293static int i2c_lpc2k_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs,
294 int msg_num)
295{
296 struct lpc2k_i2c *i2c = i2c_get_adapdata(adap);
297 int ret, i;
298 u32 stat;
299
300
301 stat = readl(i2c->base + LPC24XX_I2STAT);
302 if (stat != M_I2C_IDLE) {
303
304 return i2c_lpc2k_clear_arb(i2c);
305 }
306
307
308 for (i = 0; i < msg_num; i++) {
309
310 i2c->msg = &msgs[i];
311 i2c->msg_idx = 0;
312 i2c->msg_status = -EBUSY;
313 i2c->is_last = (i == (msg_num - 1));
314
315 ret = lpc2k_process_msg(i2c, i);
316 if (ret)
317 return ret;
318 }
319
320 return msg_num;
321}
322
323static irqreturn_t i2c_lpc2k_handler(int irq, void *dev_id)
324{
325 struct lpc2k_i2c *i2c = dev_id;
326
327 if (readl(i2c->base + LPC24XX_I2CONSET) & LPC24XX_SI) {
328 i2c_lpc2k_pump_msg(i2c);
329 return IRQ_HANDLED;
330 }
331
332 return IRQ_NONE;
333}
334
335static u32 i2c_lpc2k_functionality(struct i2c_adapter *adap)
336{
337
338 return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
339}
340
341static const struct i2c_algorithm i2c_lpc2k_algorithm = {
342 .master_xfer = i2c_lpc2k_xfer,
343 .functionality = i2c_lpc2k_functionality,
344};
345
346static int i2c_lpc2k_probe(struct platform_device *pdev)
347{
348 struct lpc2k_i2c *i2c;
349 u32 bus_clk_rate;
350 u32 scl_high;
351 u32 clkrate;
352 int ret;
353
354 i2c = devm_kzalloc(&pdev->dev, sizeof(*i2c), GFP_KERNEL);
355 if (!i2c)
356 return -ENOMEM;
357
358 i2c->base = devm_platform_ioremap_resource(pdev, 0);
359 if (IS_ERR(i2c->base))
360 return PTR_ERR(i2c->base);
361
362 i2c->irq = platform_get_irq(pdev, 0);
363 if (i2c->irq < 0)
364 return i2c->irq;
365
366 init_waitqueue_head(&i2c->wait);
367
368 i2c->clk = devm_clk_get(&pdev->dev, NULL);
369 if (IS_ERR(i2c->clk)) {
370 dev_err(&pdev->dev, "error getting clock\n");
371 return PTR_ERR(i2c->clk);
372 }
373
374 ret = clk_prepare_enable(i2c->clk);
375 if (ret) {
376 dev_err(&pdev->dev, "unable to enable clock.\n");
377 return ret;
378 }
379
380 ret = devm_request_irq(&pdev->dev, i2c->irq, i2c_lpc2k_handler, 0,
381 dev_name(&pdev->dev), i2c);
382 if (ret < 0) {
383 dev_err(&pdev->dev, "can't request interrupt.\n");
384 goto fail_clk;
385 }
386
387 disable_irq_nosync(i2c->irq);
388
389
390 i2c_lpc2k_reset(i2c);
391
392 ret = of_property_read_u32(pdev->dev.of_node, "clock-frequency",
393 &bus_clk_rate);
394 if (ret)
395 bus_clk_rate = I2C_MAX_STANDARD_MODE_FREQ;
396
397 clkrate = clk_get_rate(i2c->clk);
398 if (clkrate == 0) {
399 dev_err(&pdev->dev, "can't get I2C base clock\n");
400 ret = -EINVAL;
401 goto fail_clk;
402 }
403
404
405 clkrate = clkrate / bus_clk_rate;
406 if (bus_clk_rate <= I2C_MAX_STANDARD_MODE_FREQ)
407 scl_high = (clkrate * I2C_STD_MODE_DUTY) / 100;
408 else if (bus_clk_rate <= I2C_MAX_FAST_MODE_FREQ)
409 scl_high = (clkrate * I2C_FAST_MODE_DUTY) / 100;
410 else
411 scl_high = (clkrate * I2C_FAST_MODE_PLUS_DUTY) / 100;
412
413 writel(scl_high, i2c->base + LPC24XX_I2SCLH);
414 writel(clkrate - scl_high, i2c->base + LPC24XX_I2SCLL);
415
416 platform_set_drvdata(pdev, i2c);
417
418 i2c_set_adapdata(&i2c->adap, i2c);
419 i2c->adap.owner = THIS_MODULE;
420 strlcpy(i2c->adap.name, "LPC2K I2C adapter", sizeof(i2c->adap.name));
421 i2c->adap.algo = &i2c_lpc2k_algorithm;
422 i2c->adap.dev.parent = &pdev->dev;
423 i2c->adap.dev.of_node = pdev->dev.of_node;
424
425 ret = i2c_add_adapter(&i2c->adap);
426 if (ret < 0)
427 goto fail_clk;
428
429 dev_info(&pdev->dev, "LPC2K I2C adapter\n");
430
431 return 0;
432
433fail_clk:
434 clk_disable_unprepare(i2c->clk);
435 return ret;
436}
437
438static int i2c_lpc2k_remove(struct platform_device *dev)
439{
440 struct lpc2k_i2c *i2c = platform_get_drvdata(dev);
441
442 i2c_del_adapter(&i2c->adap);
443 clk_disable_unprepare(i2c->clk);
444
445 return 0;
446}
447
448#ifdef CONFIG_PM
449static int i2c_lpc2k_suspend(struct device *dev)
450{
451 struct lpc2k_i2c *i2c = dev_get_drvdata(dev);
452
453 clk_disable(i2c->clk);
454
455 return 0;
456}
457
458static int i2c_lpc2k_resume(struct device *dev)
459{
460 struct lpc2k_i2c *i2c = dev_get_drvdata(dev);
461
462 clk_enable(i2c->clk);
463 i2c_lpc2k_reset(i2c);
464
465 return 0;
466}
467
468static const struct dev_pm_ops i2c_lpc2k_dev_pm_ops = {
469 .suspend_noirq = i2c_lpc2k_suspend,
470 .resume_noirq = i2c_lpc2k_resume,
471};
472
473#define I2C_LPC2K_DEV_PM_OPS (&i2c_lpc2k_dev_pm_ops)
474#else
475#define I2C_LPC2K_DEV_PM_OPS NULL
476#endif
477
478static const struct of_device_id lpc2k_i2c_match[] = {
479 { .compatible = "nxp,lpc1788-i2c" },
480 {},
481};
482MODULE_DEVICE_TABLE(of, lpc2k_i2c_match);
483
484static struct platform_driver i2c_lpc2k_driver = {
485 .probe = i2c_lpc2k_probe,
486 .remove = i2c_lpc2k_remove,
487 .driver = {
488 .name = "lpc2k-i2c",
489 .pm = I2C_LPC2K_DEV_PM_OPS,
490 .of_match_table = lpc2k_i2c_match,
491 },
492};
493module_platform_driver(i2c_lpc2k_driver);
494
495MODULE_AUTHOR("Kevin Wells <kevin.wells@nxp.com>");
496MODULE_DESCRIPTION("I2C driver for LPC2xxx devices");
497MODULE_LICENSE("GPL");
498MODULE_ALIAS("platform:lpc2k-i2c");
499