1 /*
2 * SuperH Mobile I2C Controller
3 *
4 * Copyright (C) 2008 Magnus Damm
5 *
6 * Portions of the code based on out-of-tree driver i2c-sh7343.c
7 * Copyright (c) 2006 Carlos Munoz <carlos@kenati.com>
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 */
22
23 #include <linux/kernel.h>
24 #include <linux/module.h>
25 #include <linux/init.h>
26 #include <linux/delay.h>
27 #include <linux/platform_device.h>
28 #include <linux/interrupt.h>
29 #include <linux/i2c.h>
30 #include <linux/err.h>
31 #include <linux/pm_runtime.h>
32 #include <linux/clk.h>
33 #include <linux/io.h>
34 #include <linux/slab.h>
35
36 /* Transmit operation: */
37 /* */
38 /* 0 byte transmit */
39 /* BUS: S A8 ACK P */
40 /* IRQ: DTE WAIT */
41 /* ICIC: */
42 /* ICCR: 0x94 0x90 */
43 /* ICDR: A8 */
44 /* */
45 /* 1 byte transmit */
46 /* BUS: S A8 ACK D8(1) ACK P */
47 /* IRQ: DTE WAIT WAIT */
48 /* ICIC: -DTE */
49 /* ICCR: 0x94 0x90 */
50 /* ICDR: A8 D8(1) */
51 /* */
52 /* 2 byte transmit */
53 /* BUS: S A8 ACK D8(1) ACK D8(2) ACK P */
54 /* IRQ: DTE WAIT WAIT WAIT */
55 /* ICIC: -DTE */
56 /* ICCR: 0x94 0x90 */
57 /* ICDR: A8 D8(1) D8(2) */
58 /* */
59 /* 3 bytes or more, +---------+ gets repeated */
60 /* */
61 /* */
62 /* Receive operation: */
63 /* */
64 /* 0 byte receive - not supported since slave may hold SDA low */
65 /* */
66 /* 1 byte receive [TX] | [RX] */
67 /* BUS: S A8 ACK | D8(1) ACK P */
68 /* IRQ: DTE WAIT | WAIT DTE */
69 /* ICIC: -DTE | +DTE */
70 /* ICCR: 0x94 0x81 | 0xc0 */
71 /* ICDR: A8 | D8(1) */
72 /* */
73 /* 2 byte receive [TX]| [RX] */
74 /* BUS: S A8 ACK | D8(1) ACK D8(2) ACK P */
75 /* IRQ: DTE WAIT | WAIT WAIT DTE */
76 /* ICIC: -DTE | +DTE */
77 /* ICCR: 0x94 0x81 | 0xc0 */
78 /* ICDR: A8 | D8(1) D8(2) */
79 /* */
80 /* 3 byte receive [TX] | [RX] */
81 /* BUS: S A8 ACK | D8(1) ACK D8(2) ACK D8(3) ACK P */
82 /* IRQ: DTE WAIT | WAIT WAIT WAIT DTE */
83 /* ICIC: -DTE | +DTE */
84 /* ICCR: 0x94 0x81 | 0xc0 */
85 /* ICDR: A8 | D8(1) D8(2) D8(3) */
86 /* */
87 /* 4 bytes or more, this part is repeated +---------+ */
88 /* */
89 /* */
90 /* Interrupt order and BUSY flag */
91 /* ___ _ */
92 /* SDA ___\___XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXAAAAAAAAA___/ */
93 /* SCL \_/1\_/2\_/3\_/4\_/5\_/6\_/7\_/8\___/9\_____/ */
94 /* */
95 /* S D7 D6 D5 D4 D3 D2 D1 D0 P */
96 /* ___ */
97 /* WAIT IRQ ________________________________/ \___________ */
98 /* TACK IRQ ____________________________________/ \_______ */
99 /* DTE IRQ __________________________________________/ \_ */
100 /* AL IRQ XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX */
101 /* _______________________________________________ */
102 /* BUSY __/ \_ */
103 /* */
104
105 enum sh_mobile_i2c_op {
106 OP_START = 0,
107 OP_TX_FIRST,
108 OP_TX,
109 OP_TX_STOP,
110 OP_TX_TO_RX,
111 OP_RX,
112 OP_RX_STOP,
113 OP_RX_STOP_DATA,
114 };
115
116 struct sh_mobile_i2c_data {
117 struct device *dev;
118 void __iomem *reg;
119 struct i2c_adapter adap;
120
121 struct clk *clk;
122 u_int8_t icic;
123 u_int8_t iccl;
124 u_int8_t icch;
125 u_int8_t flags;
126
127 spinlock_t lock;
128 wait_queue_head_t wait;
129 struct i2c_msg *msg;
130 int pos;
131 int sr;
132 };
133
134 #define IIC_FLAG_HAS_ICIC67 (1 << 0)
135
136 #define NORMAL_SPEED 100000 /* FAST_SPEED 400000 */
137
138 /* Register offsets */
139 #define ICDR 0x00
140 #define ICCR 0x04
141 #define ICSR 0x08
142 #define ICIC 0x0c
143 #define ICCL 0x10
144 #define ICCH 0x14
145
146 /* Register bits */
147 #define ICCR_ICE 0x80
148 #define ICCR_RACK 0x40
149 #define ICCR_TRS 0x10
150 #define ICCR_BBSY 0x04
151 #define ICCR_SCP 0x01
152
153 #define ICSR_SCLM 0x80
154 #define ICSR_SDAM 0x40
155 #define SW_DONE 0x20
156 #define ICSR_BUSY 0x10
157 #define ICSR_AL 0x08
158 #define ICSR_TACK 0x04
159 #define ICSR_WAIT 0x02
160 #define ICSR_DTE 0x01
161
162 #define ICIC_ICCLB8 0x80
163 #define ICIC_ICCHB8 0x40
164 #define ICIC_ALE 0x08
165 #define ICIC_TACKE 0x04
166 #define ICIC_WAITE 0x02
167 #define ICIC_DTEE 0x01
168
iic_wr(struct sh_mobile_i2c_data * pd,int offs,unsigned char data)169 static void iic_wr(struct sh_mobile_i2c_data *pd, int offs, unsigned char data)
170 {
171 if (offs == ICIC)
172 data |= pd->icic;
173
174 iowrite8(data, pd->reg + offs);
175 }
176
iic_rd(struct sh_mobile_i2c_data * pd,int offs)177 static unsigned char iic_rd(struct sh_mobile_i2c_data *pd, int offs)
178 {
179 return ioread8(pd->reg + offs);
180 }
181
iic_set_clr(struct sh_mobile_i2c_data * pd,int offs,unsigned char set,unsigned char clr)182 static void iic_set_clr(struct sh_mobile_i2c_data *pd, int offs,
183 unsigned char set, unsigned char clr)
184 {
185 iic_wr(pd, offs, (iic_rd(pd, offs) | set) & ~clr);
186 }
187
activate_ch(struct sh_mobile_i2c_data * pd)188 static void activate_ch(struct sh_mobile_i2c_data *pd)
189 {
190 unsigned long i2c_clk;
191 u_int32_t num;
192 u_int32_t denom;
193 u_int32_t tmp;
194
195 /* Wake up device and enable clock */
196 pm_runtime_get_sync(pd->dev);
197 clk_enable(pd->clk);
198
199 /* Get clock rate after clock is enabled */
200 i2c_clk = clk_get_rate(pd->clk);
201
202 /* Calculate the value for iccl. From the data sheet:
203 * iccl = (p clock / transfer rate) * (L / (L + H))
204 * where L and H are the SCL low/high ratio (5/4 in this case).
205 * We also round off the result.
206 */
207 num = i2c_clk * 5;
208 denom = NORMAL_SPEED * 9;
209 tmp = num * 10 / denom;
210 if (tmp % 10 >= 5)
211 pd->iccl = (u_int8_t)((num/denom) + 1);
212 else
213 pd->iccl = (u_int8_t)(num/denom);
214
215 /* one more bit of ICCL in ICIC */
216 if (pd->flags & IIC_FLAG_HAS_ICIC67) {
217 if ((num/denom) > 0xff)
218 pd->icic |= ICIC_ICCLB8;
219 else
220 pd->icic &= ~ICIC_ICCLB8;
221 }
222
223 /* Calculate the value for icch. From the data sheet:
224 icch = (p clock / transfer rate) * (H / (L + H)) */
225 num = i2c_clk * 4;
226 tmp = num * 10 / denom;
227 if (tmp % 10 >= 5)
228 pd->icch = (u_int8_t)((num/denom) + 1);
229 else
230 pd->icch = (u_int8_t)(num/denom);
231
232 /* one more bit of ICCH in ICIC */
233 if (pd->flags & IIC_FLAG_HAS_ICIC67) {
234 if ((num/denom) > 0xff)
235 pd->icic |= ICIC_ICCHB8;
236 else
237 pd->icic &= ~ICIC_ICCHB8;
238 }
239
240 /* Enable channel and configure rx ack */
241 iic_set_clr(pd, ICCR, ICCR_ICE, 0);
242
243 /* Mask all interrupts */
244 iic_wr(pd, ICIC, 0);
245
246 /* Set the clock */
247 iic_wr(pd, ICCL, pd->iccl);
248 iic_wr(pd, ICCH, pd->icch);
249 }
250
deactivate_ch(struct sh_mobile_i2c_data * pd)251 static void deactivate_ch(struct sh_mobile_i2c_data *pd)
252 {
253 /* Clear/disable interrupts */
254 iic_wr(pd, ICSR, 0);
255 iic_wr(pd, ICIC, 0);
256
257 /* Disable channel */
258 iic_set_clr(pd, ICCR, 0, ICCR_ICE);
259
260 /* Disable clock and mark device as idle */
261 clk_disable(pd->clk);
262 pm_runtime_put_sync(pd->dev);
263 }
264
i2c_op(struct sh_mobile_i2c_data * pd,enum sh_mobile_i2c_op op,unsigned char data)265 static unsigned char i2c_op(struct sh_mobile_i2c_data *pd,
266 enum sh_mobile_i2c_op op, unsigned char data)
267 {
268 unsigned char ret = 0;
269 unsigned long flags;
270
271 dev_dbg(pd->dev, "op %d, data in 0x%02x\n", op, data);
272
273 spin_lock_irqsave(&pd->lock, flags);
274
275 switch (op) {
276 case OP_START: /* issue start and trigger DTE interrupt */
277 iic_wr(pd, ICCR, 0x94);
278 break;
279 case OP_TX_FIRST: /* disable DTE interrupt and write data */
280 iic_wr(pd, ICIC, ICIC_WAITE | ICIC_ALE | ICIC_TACKE);
281 iic_wr(pd, ICDR, data);
282 break;
283 case OP_TX: /* write data */
284 iic_wr(pd, ICDR, data);
285 break;
286 case OP_TX_STOP: /* write data and issue a stop afterwards */
287 iic_wr(pd, ICDR, data);
288 iic_wr(pd, ICCR, 0x90);
289 break;
290 case OP_TX_TO_RX: /* select read mode */
291 iic_wr(pd, ICCR, 0x81);
292 break;
293 case OP_RX: /* just read data */
294 ret = iic_rd(pd, ICDR);
295 break;
296 case OP_RX_STOP: /* enable DTE interrupt, issue stop */
297 iic_wr(pd, ICIC,
298 ICIC_DTEE | ICIC_WAITE | ICIC_ALE | ICIC_TACKE);
299 iic_wr(pd, ICCR, 0xc0);
300 break;
301 case OP_RX_STOP_DATA: /* enable DTE interrupt, read data, issue stop */
302 iic_wr(pd, ICIC,
303 ICIC_DTEE | ICIC_WAITE | ICIC_ALE | ICIC_TACKE);
304 ret = iic_rd(pd, ICDR);
305 iic_wr(pd, ICCR, 0xc0);
306 break;
307 }
308
309 spin_unlock_irqrestore(&pd->lock, flags);
310
311 dev_dbg(pd->dev, "op %d, data out 0x%02x\n", op, ret);
312 return ret;
313 }
314
sh_mobile_i2c_is_first_byte(struct sh_mobile_i2c_data * pd)315 static int sh_mobile_i2c_is_first_byte(struct sh_mobile_i2c_data *pd)
316 {
317 if (pd->pos == -1)
318 return 1;
319
320 return 0;
321 }
322
sh_mobile_i2c_is_last_byte(struct sh_mobile_i2c_data * pd)323 static int sh_mobile_i2c_is_last_byte(struct sh_mobile_i2c_data *pd)
324 {
325 if (pd->pos == (pd->msg->len - 1))
326 return 1;
327
328 return 0;
329 }
330
sh_mobile_i2c_get_data(struct sh_mobile_i2c_data * pd,unsigned char * buf)331 static void sh_mobile_i2c_get_data(struct sh_mobile_i2c_data *pd,
332 unsigned char *buf)
333 {
334 switch (pd->pos) {
335 case -1:
336 *buf = (pd->msg->addr & 0x7f) << 1;
337 *buf |= (pd->msg->flags & I2C_M_RD) ? 1 : 0;
338 break;
339 default:
340 *buf = pd->msg->buf[pd->pos];
341 }
342 }
343
sh_mobile_i2c_isr_tx(struct sh_mobile_i2c_data * pd)344 static int sh_mobile_i2c_isr_tx(struct sh_mobile_i2c_data *pd)
345 {
346 unsigned char data;
347
348 if (pd->pos == pd->msg->len)
349 return 1;
350
351 sh_mobile_i2c_get_data(pd, &data);
352
353 if (sh_mobile_i2c_is_last_byte(pd))
354 i2c_op(pd, OP_TX_STOP, data);
355 else if (sh_mobile_i2c_is_first_byte(pd))
356 i2c_op(pd, OP_TX_FIRST, data);
357 else
358 i2c_op(pd, OP_TX, data);
359
360 pd->pos++;
361 return 0;
362 }
363
sh_mobile_i2c_isr_rx(struct sh_mobile_i2c_data * pd)364 static int sh_mobile_i2c_isr_rx(struct sh_mobile_i2c_data *pd)
365 {
366 unsigned char data;
367 int real_pos;
368
369 do {
370 if (pd->pos <= -1) {
371 sh_mobile_i2c_get_data(pd, &data);
372
373 if (sh_mobile_i2c_is_first_byte(pd))
374 i2c_op(pd, OP_TX_FIRST, data);
375 else
376 i2c_op(pd, OP_TX, data);
377 break;
378 }
379
380 if (pd->pos == 0) {
381 i2c_op(pd, OP_TX_TO_RX, 0);
382 break;
383 }
384
385 real_pos = pd->pos - 2;
386
387 if (pd->pos == pd->msg->len) {
388 if (real_pos < 0) {
389 i2c_op(pd, OP_RX_STOP, 0);
390 break;
391 }
392 data = i2c_op(pd, OP_RX_STOP_DATA, 0);
393 } else
394 data = i2c_op(pd, OP_RX, 0);
395
396 if (real_pos >= 0)
397 pd->msg->buf[real_pos] = data;
398 } while (0);
399
400 pd->pos++;
401 return pd->pos == (pd->msg->len + 2);
402 }
403
sh_mobile_i2c_isr(int irq,void * dev_id)404 static irqreturn_t sh_mobile_i2c_isr(int irq, void *dev_id)
405 {
406 struct platform_device *dev = dev_id;
407 struct sh_mobile_i2c_data *pd = platform_get_drvdata(dev);
408 unsigned char sr;
409 int wakeup;
410
411 sr = iic_rd(pd, ICSR);
412 pd->sr |= sr; /* remember state */
413
414 dev_dbg(pd->dev, "i2c_isr 0x%02x 0x%02x %s %d %d!\n", sr, pd->sr,
415 (pd->msg->flags & I2C_M_RD) ? "read" : "write",
416 pd->pos, pd->msg->len);
417
418 if (sr & (ICSR_AL | ICSR_TACK)) {
419 /* don't interrupt transaction - continue to issue stop */
420 iic_wr(pd, ICSR, sr & ~(ICSR_AL | ICSR_TACK));
421 wakeup = 0;
422 } else if (pd->msg->flags & I2C_M_RD)
423 wakeup = sh_mobile_i2c_isr_rx(pd);
424 else
425 wakeup = sh_mobile_i2c_isr_tx(pd);
426
427 if (sr & ICSR_WAIT) /* TODO: add delay here to support slow acks */
428 iic_wr(pd, ICSR, sr & ~ICSR_WAIT);
429
430 if (wakeup) {
431 pd->sr |= SW_DONE;
432 wake_up(&pd->wait);
433 }
434
435 return IRQ_HANDLED;
436 }
437
start_ch(struct sh_mobile_i2c_data * pd,struct i2c_msg * usr_msg)438 static int start_ch(struct sh_mobile_i2c_data *pd, struct i2c_msg *usr_msg)
439 {
440 if (usr_msg->len == 0 && (usr_msg->flags & I2C_M_RD)) {
441 dev_err(pd->dev, "Unsupported zero length i2c read\n");
442 return -EIO;
443 }
444
445 /* Initialize channel registers */
446 iic_set_clr(pd, ICCR, 0, ICCR_ICE);
447
448 /* Enable channel and configure rx ack */
449 iic_set_clr(pd, ICCR, ICCR_ICE, 0);
450
451 /* Set the clock */
452 iic_wr(pd, ICCL, pd->iccl);
453 iic_wr(pd, ICCH, pd->icch);
454
455 pd->msg = usr_msg;
456 pd->pos = -1;
457 pd->sr = 0;
458
459 /* Enable all interrupts to begin with */
460 iic_wr(pd, ICIC, ICIC_DTEE | ICIC_WAITE | ICIC_ALE | ICIC_TACKE);
461 return 0;
462 }
463
sh_mobile_i2c_xfer(struct i2c_adapter * adapter,struct i2c_msg * msgs,int num)464 static int sh_mobile_i2c_xfer(struct i2c_adapter *adapter,
465 struct i2c_msg *msgs,
466 int num)
467 {
468 struct sh_mobile_i2c_data *pd = i2c_get_adapdata(adapter);
469 struct i2c_msg *msg;
470 int err = 0;
471 u_int8_t val;
472 int i, k, retry_count;
473
474 activate_ch(pd);
475
476 /* Process all messages */
477 for (i = 0; i < num; i++) {
478 msg = &msgs[i];
479
480 err = start_ch(pd, msg);
481 if (err)
482 break;
483
484 i2c_op(pd, OP_START, 0);
485
486 /* The interrupt handler takes care of the rest... */
487 k = wait_event_timeout(pd->wait,
488 pd->sr & (ICSR_TACK | SW_DONE),
489 5 * HZ);
490 if (!k)
491 dev_err(pd->dev, "Transfer request timed out\n");
492
493 retry_count = 1000;
494 again:
495 val = iic_rd(pd, ICSR);
496
497 dev_dbg(pd->dev, "val 0x%02x pd->sr 0x%02x\n", val, pd->sr);
498
499 /* the interrupt handler may wake us up before the
500 * transfer is finished, so poll the hardware
501 * until we're done.
502 */
503 if (val & ICSR_BUSY) {
504 udelay(10);
505 if (retry_count--)
506 goto again;
507
508 err = -EIO;
509 dev_err(pd->dev, "Polling timed out\n");
510 break;
511 }
512
513 /* handle missing acknowledge and arbitration lost */
514 if ((val | pd->sr) & (ICSR_TACK | ICSR_AL)) {
515 err = -EIO;
516 break;
517 }
518 }
519
520 deactivate_ch(pd);
521
522 if (!err)
523 err = num;
524 return err;
525 }
526
sh_mobile_i2c_func(struct i2c_adapter * adapter)527 static u32 sh_mobile_i2c_func(struct i2c_adapter *adapter)
528 {
529 return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
530 }
531
532 static struct i2c_algorithm sh_mobile_i2c_algorithm = {
533 .functionality = sh_mobile_i2c_func,
534 .master_xfer = sh_mobile_i2c_xfer,
535 };
536
sh_mobile_i2c_hook_irqs(struct platform_device * dev,int hook)537 static int sh_mobile_i2c_hook_irqs(struct platform_device *dev, int hook)
538 {
539 struct resource *res;
540 int ret = -ENXIO;
541 int n, k = 0;
542
543 while ((res = platform_get_resource(dev, IORESOURCE_IRQ, k))) {
544 for (n = res->start; hook && n <= res->end; n++) {
545 if (request_irq(n, sh_mobile_i2c_isr, IRQF_DISABLED,
546 dev_name(&dev->dev), dev)) {
547 for (n--; n >= res->start; n--)
548 free_irq(n, dev);
549
550 goto rollback;
551 }
552 }
553 k++;
554 }
555
556 if (hook)
557 return k > 0 ? 0 : -ENOENT;
558
559 ret = 0;
560
561 rollback:
562 k--;
563
564 while (k >= 0) {
565 res = platform_get_resource(dev, IORESOURCE_IRQ, k);
566 for (n = res->start; n <= res->end; n++)
567 free_irq(n, dev);
568
569 k--;
570 }
571
572 return ret;
573 }
574
sh_mobile_i2c_probe(struct platform_device * dev)575 static int sh_mobile_i2c_probe(struct platform_device *dev)
576 {
577 struct sh_mobile_i2c_data *pd;
578 struct i2c_adapter *adap;
579 struct resource *res;
580 char clk_name[8];
581 int size;
582 int ret;
583
584 pd = kzalloc(sizeof(struct sh_mobile_i2c_data), GFP_KERNEL);
585 if (pd == NULL) {
586 dev_err(&dev->dev, "cannot allocate private data\n");
587 return -ENOMEM;
588 }
589
590 snprintf(clk_name, sizeof(clk_name), "i2c%d", dev->id);
591 pd->clk = clk_get(&dev->dev, clk_name);
592 if (IS_ERR(pd->clk)) {
593 dev_err(&dev->dev, "cannot get clock \"%s\"\n", clk_name);
594 ret = PTR_ERR(pd->clk);
595 goto err;
596 }
597
598 ret = sh_mobile_i2c_hook_irqs(dev, 1);
599 if (ret) {
600 dev_err(&dev->dev, "cannot request IRQ\n");
601 goto err_clk;
602 }
603
604 pd->dev = &dev->dev;
605 platform_set_drvdata(dev, pd);
606
607 res = platform_get_resource(dev, IORESOURCE_MEM, 0);
608 if (res == NULL) {
609 dev_err(&dev->dev, "cannot find IO resource\n");
610 ret = -ENOENT;
611 goto err_irq;
612 }
613
614 size = resource_size(res);
615
616 pd->reg = ioremap(res->start, size);
617 if (pd->reg == NULL) {
618 dev_err(&dev->dev, "cannot map IO\n");
619 ret = -ENXIO;
620 goto err_irq;
621 }
622
623 /* The IIC blocks on SH-Mobile ARM processors
624 * come with two new bits in ICIC.
625 */
626 if (size > 0x17)
627 pd->flags |= IIC_FLAG_HAS_ICIC67;
628
629 /* Enable Runtime PM for this device.
630 *
631 * Also tell the Runtime PM core to ignore children
632 * for this device since it is valid for us to suspend
633 * this I2C master driver even though the slave devices
634 * on the I2C bus may not be suspended.
635 *
636 * The state of the I2C hardware bus is unaffected by
637 * the Runtime PM state.
638 */
639 pm_suspend_ignore_children(&dev->dev, true);
640 pm_runtime_enable(&dev->dev);
641
642 /* setup the private data */
643 adap = &pd->adap;
644 i2c_set_adapdata(adap, pd);
645
646 adap->owner = THIS_MODULE;
647 adap->algo = &sh_mobile_i2c_algorithm;
648 adap->dev.parent = &dev->dev;
649 adap->retries = 5;
650 adap->nr = dev->id;
651
652 strlcpy(adap->name, dev->name, sizeof(adap->name));
653
654 spin_lock_init(&pd->lock);
655 init_waitqueue_head(&pd->wait);
656
657 ret = i2c_add_numbered_adapter(adap);
658 if (ret < 0) {
659 dev_err(&dev->dev, "cannot add numbered adapter\n");
660 goto err_all;
661 }
662
663 return 0;
664
665 err_all:
666 iounmap(pd->reg);
667 err_irq:
668 sh_mobile_i2c_hook_irqs(dev, 0);
669 err_clk:
670 clk_put(pd->clk);
671 err:
672 kfree(pd);
673 return ret;
674 }
675
sh_mobile_i2c_remove(struct platform_device * dev)676 static int sh_mobile_i2c_remove(struct platform_device *dev)
677 {
678 struct sh_mobile_i2c_data *pd = platform_get_drvdata(dev);
679
680 i2c_del_adapter(&pd->adap);
681 iounmap(pd->reg);
682 sh_mobile_i2c_hook_irqs(dev, 0);
683 clk_put(pd->clk);
684 pm_runtime_disable(&dev->dev);
685 kfree(pd);
686 return 0;
687 }
688
sh_mobile_i2c_runtime_nop(struct device * dev)689 static int sh_mobile_i2c_runtime_nop(struct device *dev)
690 {
691 /* Runtime PM callback shared between ->runtime_suspend()
692 * and ->runtime_resume(). Simply returns success.
693 *
694 * This driver re-initializes all registers after
695 * pm_runtime_get_sync() anyway so there is no need
696 * to save and restore registers here.
697 */
698 return 0;
699 }
700
701 static const struct dev_pm_ops sh_mobile_i2c_dev_pm_ops = {
702 .runtime_suspend = sh_mobile_i2c_runtime_nop,
703 .runtime_resume = sh_mobile_i2c_runtime_nop,
704 };
705
706 static struct platform_driver sh_mobile_i2c_driver = {
707 .driver = {
708 .name = "i2c-sh_mobile",
709 .owner = THIS_MODULE,
710 .pm = &sh_mobile_i2c_dev_pm_ops,
711 },
712 .probe = sh_mobile_i2c_probe,
713 .remove = sh_mobile_i2c_remove,
714 };
715
sh_mobile_i2c_adap_init(void)716 static int __init sh_mobile_i2c_adap_init(void)
717 {
718 return platform_driver_register(&sh_mobile_i2c_driver);
719 }
720
sh_mobile_i2c_adap_exit(void)721 static void __exit sh_mobile_i2c_adap_exit(void)
722 {
723 platform_driver_unregister(&sh_mobile_i2c_driver);
724 }
725
726 subsys_initcall(sh_mobile_i2c_adap_init);
727 module_exit(sh_mobile_i2c_adap_exit);
728
729 MODULE_DESCRIPTION("SuperH Mobile I2C Bus Controller driver");
730 MODULE_AUTHOR("Magnus Damm");
731 MODULE_LICENSE("GPL v2");
732