1
2
3
4
5
6
7
8
9
10#include <linux/completion.h>
11#include <linux/delay.h>
12#include <linux/err.h>
13#include <linux/i2c.h>
14#include <linux/init.h>
15#include <linux/interrupt.h>
16#include <linux/ioport.h>
17#include <linux/platform_device.h>
18#include <linux/slab.h>
19#include <linux/io.h>
20#include <linux/module.h>
21
22#include <asm/clock.h>
23#include <asm/i2c-sh7760.h>
24
25
26#define I2CSCR 0x0
27#define I2CMCR 0x4
28#define I2CSSR 0x8
29#define I2CMSR 0xC
30#define I2CSIER 0x10
31#define I2CMIER 0x14
32#define I2CCCR 0x18
33#define I2CSAR 0x1c
34#define I2CMAR 0x20
35#define I2CRXTX 0x24
36#define I2CFCR 0x28
37#define I2CFSR 0x2C
38#define I2CFIER 0x30
39#define I2CRFDR 0x34
40#define I2CTFDR 0x38
41
42#define REGSIZE 0x3C
43
44#define MCR_MDBS 0x80
45#define MCR_FSCL 0x40
46#define MCR_FSDA 0x20
47#define MCR_OBPC 0x10
48#define MCR_MIE 0x08
49#define MCR_TSBE 0x04
50#define MCR_FSB 0x02
51#define MCR_ESG 0x01
52
53#define MSR_MNR 0x40
54#define MSR_MAL 0x20
55#define MSR_MST 0x10
56#define MSR_MDE 0x08
57#define MSR_MDT 0x04
58#define MSR_MDR 0x02
59#define MSR_MAT 0x01
60
61#define MIE_MNRE 0x40
62#define MIE_MALE 0x20
63#define MIE_MSTE 0x10
64#define MIE_MDEE 0x08
65#define MIE_MDTE 0x04
66#define MIE_MDRE 0x02
67#define MIE_MATE 0x01
68
69#define FCR_RFRST 0x02
70#define FCR_TFRST 0x01
71
72#define FSR_TEND 0x04
73#define FSR_RDF 0x02
74#define FSR_TDFE 0x01
75
76#define FIER_TEIE 0x04
77#define FIER_RXIE 0x02
78#define FIER_TXIE 0x01
79
80#define FIFO_SIZE 16
81
82struct cami2c {
83 void __iomem *iobase;
84 struct i2c_adapter adap;
85
86
87 struct i2c_msg *msg;
88#define IDF_SEND 1
89#define IDF_RECV 2
90#define IDF_STOP 4
91 int flags;
92
93#define IDS_DONE 1
94#define IDS_ARBLOST 2
95#define IDS_NACK 4
96 int status;
97 struct completion xfer_done;
98
99 int irq;
100 struct resource *ioarea;
101};
102
103static inline void OUT32(struct cami2c *cam, int reg, unsigned long val)
104{
105 __raw_writel(val, (unsigned long)cam->iobase + reg);
106}
107
108static inline unsigned long IN32(struct cami2c *cam, int reg)
109{
110 return __raw_readl((unsigned long)cam->iobase + reg);
111}
112
113static irqreturn_t sh7760_i2c_irq(int irq, void *ptr)
114{
115 struct cami2c *id = ptr;
116 struct i2c_msg *msg = id->msg;
117 char *data = msg->buf;
118 unsigned long msr, fsr, fier, len;
119
120 msr = IN32(id, I2CMSR);
121 fsr = IN32(id, I2CFSR);
122
123
124 if (msr & MSR_MAL) {
125 OUT32(id, I2CMCR, 0);
126 OUT32(id, I2CSCR, 0);
127 OUT32(id, I2CSAR, 0);
128 id->status |= IDS_DONE | IDS_ARBLOST;
129 goto out;
130 }
131
132 if (msr & MSR_MNR) {
133
134
135
136
137
138
139 udelay(100);
140 OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST);
141 OUT32(id, I2CMCR, MCR_MIE | MCR_FSB);
142 OUT32(id, I2CFIER, 0);
143 OUT32(id, I2CMIER, MIE_MSTE);
144 OUT32(id, I2CSCR, 0);
145 OUT32(id, I2CSAR, 0);
146 id->status |= IDS_NACK;
147 msr &= ~MSR_MAT;
148 fsr = 0;
149
150 }
151
152
153 if (msr & MSR_MST) {
154 id->status |= IDS_DONE;
155 goto out;
156 }
157
158
159 if (msr & MSR_MAT)
160 OUT32(id, I2CMCR, MCR_MIE);
161
162 fier = IN32(id, I2CFIER);
163
164 if (fsr & FSR_RDF) {
165 len = IN32(id, I2CRFDR);
166 if (msg->len <= len) {
167 if (id->flags & IDF_STOP) {
168 OUT32(id, I2CMCR, MCR_MIE | MCR_FSB);
169 OUT32(id, I2CFIER, 0);
170
171 udelay(5);
172
173 } else {
174 id->status |= IDS_DONE;
175
176
177
178
179 fsr &= ~FSR_RDF;
180 }
181 }
182 while (msg->len && len) {
183 *data++ = IN32(id, I2CRXTX);
184 msg->len--;
185 len--;
186 }
187
188 if (msg->len) {
189 len = (msg->len >= FIFO_SIZE) ? FIFO_SIZE - 1
190 : msg->len - 1;
191
192 OUT32(id, I2CFCR, FCR_TFRST | ((len & 0xf) << 4));
193 }
194
195 } else if (id->flags & IDF_SEND) {
196 if ((fsr & FSR_TEND) && (msg->len < 1)) {
197 if (id->flags & IDF_STOP) {
198 OUT32(id, I2CMCR, MCR_MIE | MCR_FSB);
199 } else {
200 id->status |= IDS_DONE;
201
202
203
204
205 fsr &= ~FSR_TEND;
206 }
207 }
208 if (fsr & FSR_TDFE) {
209 while (msg->len && (IN32(id, I2CTFDR) < FIFO_SIZE)) {
210 OUT32(id, I2CRXTX, *data++);
211 msg->len--;
212 }
213
214 if (msg->len < 1) {
215 fier &= ~FIER_TXIE;
216 OUT32(id, I2CFIER, fier);
217 } else {
218 len = (msg->len >= FIFO_SIZE) ? 2 : 0;
219 OUT32(id, I2CFCR,
220 FCR_RFRST | ((len & 3) << 2));
221 }
222 }
223 }
224out:
225 if (id->status & IDS_DONE) {
226 OUT32(id, I2CMIER, 0);
227 OUT32(id, I2CFIER, 0);
228 id->msg = NULL;
229 complete(&id->xfer_done);
230 }
231
232 OUT32(id, I2CMSR, ~msr);
233 OUT32(id, I2CFSR, ~fsr);
234 OUT32(id, I2CSSR, 0);
235
236 return IRQ_HANDLED;
237}
238
239
240
241static void sh7760_i2c_mrecv(struct cami2c *id)
242{
243 int len;
244
245 id->flags |= IDF_RECV;
246
247
248 OUT32(id, I2CSAR, 0xfe);
249 OUT32(id, I2CMAR, (id->msg->addr << 1) | 1);
250
251
252 if (id->msg->len >= FIFO_SIZE)
253 len = FIFO_SIZE - 1;
254 else
255 len = id->msg->len - 1;
256
257 OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST);
258 OUT32(id, I2CFCR, FCR_TFRST | ((len & 0xF) << 4));
259
260 OUT32(id, I2CMSR, 0);
261 OUT32(id, I2CMCR, MCR_MIE | MCR_ESG);
262 OUT32(id, I2CMIER, MIE_MNRE | MIE_MALE | MIE_MSTE | MIE_MATE);
263 OUT32(id, I2CFIER, FIER_RXIE);
264}
265
266
267static void sh7760_i2c_msend(struct cami2c *id)
268{
269 int len;
270
271 id->flags |= IDF_SEND;
272
273
274 OUT32(id, I2CSAR, 0xfe);
275 OUT32(id, I2CMAR, (id->msg->addr << 1) | 0);
276
277
278 if (id->msg->len >= FIFO_SIZE)
279 len = 2;
280 else
281 len = 0;
282
283 OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST);
284 OUT32(id, I2CFCR, FCR_RFRST | ((len & 3) << 2));
285
286 while (id->msg->len && IN32(id, I2CTFDR) < FIFO_SIZE) {
287 OUT32(id, I2CRXTX, *(id->msg->buf));
288 (id->msg->len)--;
289 (id->msg->buf)++;
290 }
291
292 OUT32(id, I2CMSR, 0);
293 OUT32(id, I2CMCR, MCR_MIE | MCR_ESG);
294 OUT32(id, I2CFSR, 0);
295 OUT32(id, I2CMIER, MIE_MNRE | MIE_MALE | MIE_MSTE | MIE_MATE);
296 OUT32(id, I2CFIER, FIER_TEIE | (id->msg->len ? FIER_TXIE : 0));
297}
298
299static inline int sh7760_i2c_busy_check(struct cami2c *id)
300{
301 return (IN32(id, I2CMCR) & MCR_FSDA);
302}
303
304static int sh7760_i2c_master_xfer(struct i2c_adapter *adap,
305 struct i2c_msg *msgs,
306 int num)
307{
308 struct cami2c *id = adap->algo_data;
309 int i, retr;
310
311 if (sh7760_i2c_busy_check(id)) {
312 dev_err(&adap->dev, "sh7760-i2c%d: bus busy!\n", adap->nr);
313 return -EBUSY;
314 }
315
316 i = 0;
317 while (i < num) {
318 retr = adap->retries;
319retry:
320 id->flags = ((i == (num-1)) ? IDF_STOP : 0);
321 id->status = 0;
322 id->msg = msgs;
323 init_completion(&id->xfer_done);
324
325 if (msgs->flags & I2C_M_RD)
326 sh7760_i2c_mrecv(id);
327 else
328 sh7760_i2c_msend(id);
329
330 wait_for_completion(&id->xfer_done);
331
332 if (id->status == 0) {
333 num = -EIO;
334 break;
335 }
336
337 if (id->status & IDS_NACK) {
338
339 mdelay(1);
340 num = -EREMOTEIO;
341 break;
342 }
343
344 if (id->status & IDS_ARBLOST) {
345 if (retr--) {
346 mdelay(2);
347 goto retry;
348 }
349 num = -EREMOTEIO;
350 break;
351 }
352
353 msgs++;
354 i++;
355 }
356
357 id->msg = NULL;
358 id->flags = 0;
359 id->status = 0;
360
361 OUT32(id, I2CMCR, 0);
362 OUT32(id, I2CMSR, 0);
363 OUT32(id, I2CMIER, 0);
364 OUT32(id, I2CFIER, 0);
365
366
367
368
369
370 OUT32(id, I2CSCR, 0);
371 OUT32(id, I2CSAR, 0);
372 OUT32(id, I2CSSR, 0);
373
374 return num;
375}
376
377static u32 sh7760_i2c_func(struct i2c_adapter *adap)
378{
379 return I2C_FUNC_I2C | (I2C_FUNC_SMBUS_EMUL & ~I2C_FUNC_SMBUS_QUICK);
380}
381
382static const struct i2c_algorithm sh7760_i2c_algo = {
383 .master_xfer = sh7760_i2c_master_xfer,
384 .functionality = sh7760_i2c_func,
385};
386
387
388
389
390
391
392
393static int calc_CCR(unsigned long scl_hz)
394{
395 struct clk *mclk;
396 unsigned long mck, m1, dff, odff, iclk;
397 signed char cdf, cdfm;
398 int scgd, scgdm, scgds;
399
400 mclk = clk_get(NULL, "peripheral_clk");
401 if (IS_ERR(mclk)) {
402 return PTR_ERR(mclk);
403 } else {
404 mck = mclk->rate;
405 clk_put(mclk);
406 }
407
408 odff = scl_hz;
409 scgdm = cdfm = m1 = 0;
410 for (cdf = 3; cdf >= 0; cdf--) {
411 iclk = mck / (1 + cdf);
412 if (iclk >= 20000000)
413 continue;
414 scgds = ((iclk / scl_hz) - 20) >> 3;
415 for (scgd = scgds; (scgd < 63) && scgd <= scgds + 1; scgd++) {
416 m1 = iclk / (20 + (scgd << 3));
417 dff = abs(scl_hz - m1);
418 if (dff < odff) {
419 odff = dff;
420 cdfm = cdf;
421 scgdm = scgd;
422 }
423 }
424 }
425
426 if (odff > (scl_hz >> 2))
427 return -EINVAL;
428
429
430 return ((scgdm << 2) | cdfm);
431}
432
433static int sh7760_i2c_probe(struct platform_device *pdev)
434{
435 struct sh7760_i2c_platdata *pd;
436 struct resource *res;
437 struct cami2c *id;
438 int ret;
439
440 pd = pdev->dev.platform_data;
441 if (!pd) {
442 dev_err(&pdev->dev, "no platform_data!\n");
443 ret = -ENODEV;
444 goto out0;
445 }
446
447 id = kzalloc(sizeof(struct cami2c), GFP_KERNEL);
448 if (!id) {
449 dev_err(&pdev->dev, "no mem for private data\n");
450 ret = -ENOMEM;
451 goto out0;
452 }
453
454 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
455 if (!res) {
456 dev_err(&pdev->dev, "no mmio resources\n");
457 ret = -ENODEV;
458 goto out1;
459 }
460
461 id->ioarea = request_mem_region(res->start, REGSIZE, pdev->name);
462 if (!id->ioarea) {
463 dev_err(&pdev->dev, "mmio already reserved\n");
464 ret = -EBUSY;
465 goto out1;
466 }
467
468 id->iobase = ioremap(res->start, REGSIZE);
469 if (!id->iobase) {
470 dev_err(&pdev->dev, "cannot ioremap\n");
471 ret = -ENODEV;
472 goto out2;
473 }
474
475 id->irq = platform_get_irq(pdev, 0);
476
477 id->adap.nr = pdev->id;
478 id->adap.algo = &sh7760_i2c_algo;
479 id->adap.class = I2C_CLASS_HWMON | I2C_CLASS_SPD;
480 id->adap.retries = 3;
481 id->adap.algo_data = id;
482 id->adap.dev.parent = &pdev->dev;
483 snprintf(id->adap.name, sizeof(id->adap.name),
484 "SH7760 I2C at %08lx", (unsigned long)res->start);
485
486 OUT32(id, I2CMCR, 0);
487 OUT32(id, I2CMSR, 0);
488 OUT32(id, I2CMIER, 0);
489 OUT32(id, I2CMAR, 0);
490 OUT32(id, I2CSIER, 0);
491 OUT32(id, I2CSAR, 0);
492 OUT32(id, I2CSCR, 0);
493 OUT32(id, I2CSSR, 0);
494 OUT32(id, I2CFIER, 0);
495 OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST);
496 OUT32(id, I2CFSR, 0);
497
498 ret = calc_CCR(pd->speed_khz * 1000);
499 if (ret < 0) {
500 dev_err(&pdev->dev, "invalid SCL clock: %dkHz\n",
501 pd->speed_khz);
502 goto out3;
503 }
504 OUT32(id, I2CCCR, ret);
505
506 if (request_irq(id->irq, sh7760_i2c_irq, 0,
507 SH7760_I2C_DEVNAME, id)) {
508 dev_err(&pdev->dev, "cannot get irq %d\n", id->irq);
509 ret = -EBUSY;
510 goto out3;
511 }
512
513 ret = i2c_add_numbered_adapter(&id->adap);
514 if (ret < 0) {
515 dev_err(&pdev->dev, "reg adap failed: %d\n", ret);
516 goto out4;
517 }
518
519 platform_set_drvdata(pdev, id);
520
521 dev_info(&pdev->dev, "%d kHz mmio %08x irq %d\n",
522 pd->speed_khz, res->start, id->irq);
523
524 return 0;
525
526out4:
527 free_irq(id->irq, id);
528out3:
529 iounmap(id->iobase);
530out2:
531 release_resource(id->ioarea);
532 kfree(id->ioarea);
533out1:
534 kfree(id);
535out0:
536 return ret;
537}
538
539static int sh7760_i2c_remove(struct platform_device *pdev)
540{
541 struct cami2c *id = platform_get_drvdata(pdev);
542
543 i2c_del_adapter(&id->adap);
544 free_irq(id->irq, id);
545 iounmap(id->iobase);
546 release_resource(id->ioarea);
547 kfree(id->ioarea);
548 kfree(id);
549
550 return 0;
551}
552
553static struct platform_driver sh7760_i2c_drv = {
554 .driver = {
555 .name = SH7760_I2C_DEVNAME,
556 .owner = THIS_MODULE,
557 },
558 .probe = sh7760_i2c_probe,
559 .remove = sh7760_i2c_remove,
560};
561
562module_platform_driver(sh7760_i2c_drv);
563
564MODULE_LICENSE("GPL");
565MODULE_DESCRIPTION("SH7760 I2C bus driver");
566MODULE_AUTHOR("Manuel Lauss <mano@roarinelk.homelinux.net>");
567