Version:  2.0.40 2.2.26 2.4.37 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16 3.17 3.18 3.19 4.0

Linux/drivers/i2c/busses/i2c-rcar.c

  1 /*
  2  * Driver for the Renesas RCar I2C unit
  3  *
  4  * Copyright (C) 2014 Wolfram Sang <wsa@sang-engineering.com>
  5  *
  6  * Copyright (C) 2012-14 Renesas Solutions Corp.
  7  * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
  8  *
  9  * This file is based on the drivers/i2c/busses/i2c-sh7760.c
 10  * (c) 2005-2008 MSC Vertriebsges.m.b.H, Manuel Lauss <mlau@msc-ge.com>
 11  *
 12  * This file used out-of-tree driver i2c-rcar.c
 13  * Copyright (C) 2011-2012 Renesas Electronics Corporation
 14  *
 15  * This program is free software; you can redistribute it and/or modify
 16  * it under the terms of the GNU General Public License as published by
 17  * the Free Software Foundation; version 2 of the License.
 18  *
 19  * This program is distributed in the hope that it will be useful,
 20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 22  * GNU General Public License for more details.
 23  */
 24 #include <linux/clk.h>
 25 #include <linux/delay.h>
 26 #include <linux/err.h>
 27 #include <linux/interrupt.h>
 28 #include <linux/io.h>
 29 #include <linux/i2c.h>
 30 #include <linux/i2c/i2c-rcar.h>
 31 #include <linux/kernel.h>
 32 #include <linux/module.h>
 33 #include <linux/of_device.h>
 34 #include <linux/platform_device.h>
 35 #include <linux/pm_runtime.h>
 36 #include <linux/slab.h>
 37 #include <linux/spinlock.h>
 38 
 39 /* register offsets */
 40 #define ICSCR   0x00    /* slave ctrl */
 41 #define ICMCR   0x04    /* master ctrl */
 42 #define ICSSR   0x08    /* slave status */
 43 #define ICMSR   0x0C    /* master status */
 44 #define ICSIER  0x10    /* slave irq enable */
 45 #define ICMIER  0x14    /* master irq enable */
 46 #define ICCCR   0x18    /* clock dividers */
 47 #define ICSAR   0x1C    /* slave address */
 48 #define ICMAR   0x20    /* master address */
 49 #define ICRXTX  0x24    /* data port */
 50 
 51 /* ICSCR */
 52 #define SDBS    (1 << 3)        /* slave data buffer select */
 53 #define SIE     (1 << 2)        /* slave interface enable */
 54 #define GCAE    (1 << 1)        /* general call address enable */
 55 #define FNA     (1 << 0)        /* forced non acknowledgment */
 56 
 57 /* ICMCR */
 58 #define MDBS    (1 << 7)        /* non-fifo mode switch */
 59 #define FSCL    (1 << 6)        /* override SCL pin */
 60 #define FSDA    (1 << 5)        /* override SDA pin */
 61 #define OBPC    (1 << 4)        /* override pins */
 62 #define MIE     (1 << 3)        /* master if enable */
 63 #define TSBE    (1 << 2)
 64 #define FSB     (1 << 1)        /* force stop bit */
 65 #define ESG     (1 << 0)        /* en startbit gen */
 66 
 67 /* ICSSR (also for ICSIER) */
 68 #define GCAR    (1 << 6)        /* general call received */
 69 #define STM     (1 << 5)        /* slave transmit mode */
 70 #define SSR     (1 << 4)        /* stop received */
 71 #define SDE     (1 << 3)        /* slave data empty */
 72 #define SDT     (1 << 2)        /* slave data transmitted */
 73 #define SDR     (1 << 1)        /* slave data received */
 74 #define SAR     (1 << 0)        /* slave addr received */
 75 
 76 /* ICMSR (also for ICMIE) */
 77 #define MNR     (1 << 6)        /* nack received */
 78 #define MAL     (1 << 5)        /* arbitration lost */
 79 #define MST     (1 << 4)        /* sent a stop */
 80 #define MDE     (1 << 3)
 81 #define MDT     (1 << 2)
 82 #define MDR     (1 << 1)
 83 #define MAT     (1 << 0)        /* slave addr xfer done */
 84 
 85 
 86 #define RCAR_BUS_PHASE_START    (MDBS | MIE | ESG)
 87 #define RCAR_BUS_PHASE_DATA     (MDBS | MIE)
 88 #define RCAR_BUS_PHASE_STOP     (MDBS | MIE | FSB)
 89 
 90 #define RCAR_IRQ_SEND   (MNR | MAL | MST | MAT | MDE)
 91 #define RCAR_IRQ_RECV   (MNR | MAL | MST | MAT | MDR)
 92 #define RCAR_IRQ_STOP   (MST)
 93 
 94 #define RCAR_IRQ_ACK_SEND       (~(MAT | MDE) & 0xFF)
 95 #define RCAR_IRQ_ACK_RECV       (~(MAT | MDR) & 0xFF)
 96 
 97 #define ID_LAST_MSG     (1 << 0)
 98 #define ID_IOERROR      (1 << 1)
 99 #define ID_DONE         (1 << 2)
100 #define ID_ARBLOST      (1 << 3)
101 #define ID_NACK         (1 << 4)
102 
103 enum rcar_i2c_type {
104         I2C_RCAR_GEN1,
105         I2C_RCAR_GEN2,
106 };
107 
108 struct rcar_i2c_priv {
109         void __iomem *io;
110         struct i2c_adapter adap;
111         struct i2c_msg  *msg;
112         struct clk *clk;
113 
114         spinlock_t lock;
115         wait_queue_head_t wait;
116 
117         int pos;
118         u32 icccr;
119         u32 flags;
120         enum rcar_i2c_type devtype;
121         struct i2c_client *slave;
122 };
123 
124 #define rcar_i2c_priv_to_dev(p)         ((p)->adap.dev.parent)
125 #define rcar_i2c_is_recv(p)             ((p)->msg->flags & I2C_M_RD)
126 
127 #define rcar_i2c_flags_set(p, f)        ((p)->flags |= (f))
128 #define rcar_i2c_flags_has(p, f)        ((p)->flags & (f))
129 
130 #define LOOP_TIMEOUT    1024
131 
132 
133 static void rcar_i2c_write(struct rcar_i2c_priv *priv, int reg, u32 val)
134 {
135         writel(val, priv->io + reg);
136 }
137 
138 static u32 rcar_i2c_read(struct rcar_i2c_priv *priv, int reg)
139 {
140         return readl(priv->io + reg);
141 }
142 
143 static void rcar_i2c_init(struct rcar_i2c_priv *priv)
144 {
145         /* reset master mode */
146         rcar_i2c_write(priv, ICMIER, 0);
147         rcar_i2c_write(priv, ICMCR, 0);
148         rcar_i2c_write(priv, ICMSR, 0);
149         rcar_i2c_write(priv, ICMAR, 0);
150 }
151 
152 static int rcar_i2c_bus_barrier(struct rcar_i2c_priv *priv)
153 {
154         int i;
155 
156         for (i = 0; i < LOOP_TIMEOUT; i++) {
157                 /* make sure that bus is not busy */
158                 if (!(rcar_i2c_read(priv, ICMCR) & FSDA))
159                         return 0;
160                 udelay(1);
161         }
162 
163         return -EBUSY;
164 }
165 
166 static int rcar_i2c_clock_calculate(struct rcar_i2c_priv *priv,
167                                     u32 bus_speed,
168                                     struct device *dev)
169 {
170         u32 scgd, cdf;
171         u32 round, ick;
172         u32 scl;
173         u32 cdf_width;
174         unsigned long rate;
175 
176         switch (priv->devtype) {
177         case I2C_RCAR_GEN1:
178                 cdf_width = 2;
179                 break;
180         case I2C_RCAR_GEN2:
181                 cdf_width = 3;
182                 break;
183         default:
184                 dev_err(dev, "device type error\n");
185                 return -EIO;
186         }
187 
188         /*
189          * calculate SCL clock
190          * see
191          *      ICCCR
192          *
193          * ick  = clkp / (1 + CDF)
194          * SCL  = ick / (20 + SCGD * 8 + F[(ticf + tr + intd) * ick])
195          *
196          * ick  : I2C internal clock < 20 MHz
197          * ticf : I2C SCL falling time  =  35 ns here
198          * tr   : I2C SCL rising  time  = 200 ns here
199          * intd : LSI internal delay    =  50 ns here
200          * clkp : peripheral_clk
201          * F[]  : integer up-valuation
202          */
203         rate = clk_get_rate(priv->clk);
204         cdf = rate / 20000000;
205         if (cdf >= 1U << cdf_width) {
206                 dev_err(dev, "Input clock %lu too high\n", rate);
207                 return -EIO;
208         }
209         ick = rate / (cdf + 1);
210 
211         /*
212          * it is impossible to calculate large scale
213          * number on u32. separate it
214          *
215          * F[(ticf + tr + intd) * ick]
216          *  = F[(35 + 200 + 50)ns * ick]
217          *  = F[285 * ick / 1000000000]
218          *  = F[(ick / 1000000) * 285 / 1000]
219          */
220         round = (ick + 500000) / 1000000 * 285;
221         round = (round + 500) / 1000;
222 
223         /*
224          * SCL  = ick / (20 + SCGD * 8 + F[(ticf + tr + intd) * ick])
225          *
226          * Calculation result (= SCL) should be less than
227          * bus_speed for hardware safety
228          *
229          * We could use something along the lines of
230          *      div = ick / (bus_speed + 1) + 1;
231          *      scgd = (div - 20 - round + 7) / 8;
232          *      scl = ick / (20 + (scgd * 8) + round);
233          * (not fully verified) but that would get pretty involved
234          */
235         for (scgd = 0; scgd < 0x40; scgd++) {
236                 scl = ick / (20 + (scgd * 8) + round);
237                 if (scl <= bus_speed)
238                         goto scgd_find;
239         }
240         dev_err(dev, "it is impossible to calculate best SCL\n");
241         return -EIO;
242 
243 scgd_find:
244         dev_dbg(dev, "clk %d/%d(%lu), round %u, CDF:0x%x, SCGD: 0x%x\n",
245                 scl, bus_speed, clk_get_rate(priv->clk), round, cdf, scgd);
246 
247         /*
248          * keep icccr value
249          */
250         priv->icccr = scgd << cdf_width | cdf;
251 
252         return 0;
253 }
254 
255 static void rcar_i2c_prepare_msg(struct rcar_i2c_priv *priv)
256 {
257         int read = !!rcar_i2c_is_recv(priv);
258 
259         rcar_i2c_write(priv, ICMAR, (priv->msg->addr << 1) | read);
260         rcar_i2c_write(priv, ICMSR, 0);
261         rcar_i2c_write(priv, ICMCR, RCAR_BUS_PHASE_START);
262         rcar_i2c_write(priv, ICMIER, read ? RCAR_IRQ_RECV : RCAR_IRQ_SEND);
263 }
264 
265 /*
266  *              interrupt functions
267  */
268 static int rcar_i2c_irq_send(struct rcar_i2c_priv *priv, u32 msr)
269 {
270         struct i2c_msg *msg = priv->msg;
271 
272         /*
273          * FIXME
274          * sometimes, unknown interrupt happened.
275          * Do nothing
276          */
277         if (!(msr & MDE))
278                 return 0;
279 
280         /*
281          * If address transfer phase finished,
282          * goto data phase.
283          */
284         if (msr & MAT)
285                 rcar_i2c_write(priv, ICMCR, RCAR_BUS_PHASE_DATA);
286 
287         if (priv->pos < msg->len) {
288                 /*
289                  * Prepare next data to ICRXTX register.
290                  * This data will go to _SHIFT_ register.
291                  *
292                  *    *
293                  * [ICRXTX] -> [SHIFT] -> [I2C bus]
294                  */
295                 rcar_i2c_write(priv, ICRXTX, msg->buf[priv->pos]);
296                 priv->pos++;
297 
298         } else {
299                 /*
300                  * The last data was pushed to ICRXTX on _PREV_ empty irq.
301                  * It is on _SHIFT_ register, and will sent to I2C bus.
302                  *
303                  *                *
304                  * [ICRXTX] -> [SHIFT] -> [I2C bus]
305                  */
306 
307                 if (priv->flags & ID_LAST_MSG)
308                         /*
309                          * If current msg is the _LAST_ msg,
310                          * prepare stop condition here.
311                          * ID_DONE will be set on STOP irq.
312                          */
313                         rcar_i2c_write(priv, ICMCR, RCAR_BUS_PHASE_STOP);
314                 else
315                         /*
316                          * If current msg is _NOT_ last msg,
317                          * it doesn't call stop phase.
318                          * thus, there is no STOP irq.
319                          * return ID_DONE here.
320                          */
321                         return ID_DONE;
322         }
323 
324         rcar_i2c_write(priv, ICMSR, RCAR_IRQ_ACK_SEND);
325 
326         return 0;
327 }
328 
329 static int rcar_i2c_irq_recv(struct rcar_i2c_priv *priv, u32 msr)
330 {
331         struct i2c_msg *msg = priv->msg;
332 
333         /*
334          * FIXME
335          * sometimes, unknown interrupt happened.
336          * Do nothing
337          */
338         if (!(msr & MDR))
339                 return 0;
340 
341         if (msr & MAT) {
342                 /*
343                  * Address transfer phase finished,
344                  * but, there is no data at this point.
345                  * Do nothing.
346                  */
347         } else if (priv->pos < msg->len) {
348                 /*
349                  * get received data
350                  */
351                 msg->buf[priv->pos] = rcar_i2c_read(priv, ICRXTX);
352                 priv->pos++;
353         }
354 
355         /*
356          * If next received data is the _LAST_,
357          * go to STOP phase,
358          * otherwise, go to DATA phase.
359          */
360         if (priv->pos + 1 >= msg->len)
361                 rcar_i2c_write(priv, ICMCR, RCAR_BUS_PHASE_STOP);
362         else
363                 rcar_i2c_write(priv, ICMCR, RCAR_BUS_PHASE_DATA);
364 
365         rcar_i2c_write(priv, ICMSR, RCAR_IRQ_ACK_RECV);
366 
367         return 0;
368 }
369 
370 static bool rcar_i2c_slave_irq(struct rcar_i2c_priv *priv)
371 {
372         u32 ssr_raw, ssr_filtered;
373         u8 value;
374 
375         ssr_raw = rcar_i2c_read(priv, ICSSR) & 0xff;
376         ssr_filtered = ssr_raw & rcar_i2c_read(priv, ICSIER);
377 
378         if (!ssr_filtered)
379                 return false;
380 
381         /* address detected */
382         if (ssr_filtered & SAR) {
383                 /* read or write request */
384                 if (ssr_raw & STM) {
385                         i2c_slave_event(priv->slave, I2C_SLAVE_REQ_READ_START, &value);
386                         rcar_i2c_write(priv, ICRXTX, value);
387                         rcar_i2c_write(priv, ICSIER, SDE | SSR | SAR);
388                 } else {
389                         i2c_slave_event(priv->slave, I2C_SLAVE_REQ_WRITE_START, &value);
390                         rcar_i2c_read(priv, ICRXTX);    /* dummy read */
391                         rcar_i2c_write(priv, ICSIER, SDR | SSR | SAR);
392                 }
393 
394                 rcar_i2c_write(priv, ICSSR, ~SAR & 0xff);
395         }
396 
397         /* master sent stop */
398         if (ssr_filtered & SSR) {
399                 i2c_slave_event(priv->slave, I2C_SLAVE_STOP, &value);
400                 rcar_i2c_write(priv, ICSIER, SAR | SSR);
401                 rcar_i2c_write(priv, ICSSR, ~SSR & 0xff);
402         }
403 
404         /* master wants to write to us */
405         if (ssr_filtered & SDR) {
406                 int ret;
407 
408                 value = rcar_i2c_read(priv, ICRXTX);
409                 ret = i2c_slave_event(priv->slave, I2C_SLAVE_REQ_WRITE_END, &value);
410                 /* Send NACK in case of error */
411                 rcar_i2c_write(priv, ICSCR, SIE | SDBS | (ret < 0 ? FNA : 0));
412                 i2c_slave_event(priv->slave, I2C_SLAVE_REQ_WRITE_START, &value);
413                 rcar_i2c_write(priv, ICSSR, ~SDR & 0xff);
414         }
415 
416         /* master wants to read from us */
417         if (ssr_filtered & SDE) {
418                 i2c_slave_event(priv->slave, I2C_SLAVE_REQ_READ_END, &value);
419                 i2c_slave_event(priv->slave, I2C_SLAVE_REQ_READ_START, &value);
420                 rcar_i2c_write(priv, ICRXTX, value);
421                 rcar_i2c_write(priv, ICSSR, ~SDE & 0xff);
422         }
423 
424         return true;
425 }
426 
427 static irqreturn_t rcar_i2c_irq(int irq, void *ptr)
428 {
429         struct rcar_i2c_priv *priv = ptr;
430         irqreturn_t result = IRQ_HANDLED;
431         u32 msr;
432 
433         /*-------------- spin lock -----------------*/
434         spin_lock(&priv->lock);
435 
436         if (rcar_i2c_slave_irq(priv))
437                 goto exit;
438 
439         msr = rcar_i2c_read(priv, ICMSR);
440 
441         /* Only handle interrupts that are currently enabled */
442         msr &= rcar_i2c_read(priv, ICMIER);
443         if (!msr) {
444                 result = IRQ_NONE;
445                 goto exit;
446         }
447 
448         /* Arbitration lost */
449         if (msr & MAL) {
450                 rcar_i2c_flags_set(priv, (ID_DONE | ID_ARBLOST));
451                 goto out;
452         }
453 
454         /* Nack */
455         if (msr & MNR) {
456                 /* go to stop phase */
457                 rcar_i2c_write(priv, ICMCR, RCAR_BUS_PHASE_STOP);
458                 rcar_i2c_write(priv, ICMIER, RCAR_IRQ_STOP);
459                 rcar_i2c_flags_set(priv, ID_NACK);
460                 goto out;
461         }
462 
463         /* Stop */
464         if (msr & MST) {
465                 rcar_i2c_flags_set(priv, ID_DONE);
466                 goto out;
467         }
468 
469         if (rcar_i2c_is_recv(priv))
470                 rcar_i2c_flags_set(priv, rcar_i2c_irq_recv(priv, msr));
471         else
472                 rcar_i2c_flags_set(priv, rcar_i2c_irq_send(priv, msr));
473 
474 out:
475         if (rcar_i2c_flags_has(priv, ID_DONE)) {
476                 rcar_i2c_write(priv, ICMIER, 0);
477                 rcar_i2c_write(priv, ICMSR, 0);
478                 wake_up(&priv->wait);
479         }
480 
481 exit:
482         spin_unlock(&priv->lock);
483         /*-------------- spin unlock -----------------*/
484 
485         return result;
486 }
487 
488 static int rcar_i2c_master_xfer(struct i2c_adapter *adap,
489                                 struct i2c_msg *msgs,
490                                 int num)
491 {
492         struct rcar_i2c_priv *priv = i2c_get_adapdata(adap);
493         struct device *dev = rcar_i2c_priv_to_dev(priv);
494         unsigned long flags;
495         int i, ret, timeout;
496 
497         pm_runtime_get_sync(dev);
498 
499         /*-------------- spin lock -----------------*/
500         spin_lock_irqsave(&priv->lock, flags);
501 
502         rcar_i2c_init(priv);
503         /* start clock */
504         rcar_i2c_write(priv, ICCCR, priv->icccr);
505 
506         spin_unlock_irqrestore(&priv->lock, flags);
507         /*-------------- spin unlock -----------------*/
508 
509         ret = rcar_i2c_bus_barrier(priv);
510         if (ret < 0)
511                 goto out;
512 
513         for (i = 0; i < num; i++) {
514                 /* This HW can't send STOP after address phase */
515                 if (msgs[i].len == 0) {
516                         ret = -EOPNOTSUPP;
517                         break;
518                 }
519 
520                 /*-------------- spin lock -----------------*/
521                 spin_lock_irqsave(&priv->lock, flags);
522 
523                 /* init each data */
524                 priv->msg       = &msgs[i];
525                 priv->pos       = 0;
526                 priv->flags     = 0;
527                 if (i == num - 1)
528                         rcar_i2c_flags_set(priv, ID_LAST_MSG);
529 
530                 rcar_i2c_prepare_msg(priv);
531 
532                 spin_unlock_irqrestore(&priv->lock, flags);
533                 /*-------------- spin unlock -----------------*/
534 
535                 timeout = wait_event_timeout(priv->wait,
536                                              rcar_i2c_flags_has(priv, ID_DONE),
537                                              5 * HZ);
538                 if (!timeout) {
539                         ret = -ETIMEDOUT;
540                         break;
541                 }
542 
543                 if (rcar_i2c_flags_has(priv, ID_NACK)) {
544                         ret = -ENXIO;
545                         break;
546                 }
547 
548                 if (rcar_i2c_flags_has(priv, ID_ARBLOST)) {
549                         ret = -EAGAIN;
550                         break;
551                 }
552 
553                 if (rcar_i2c_flags_has(priv, ID_IOERROR)) {
554                         ret = -EIO;
555                         break;
556                 }
557 
558                 ret = i + 1; /* The number of transfer */
559         }
560 out:
561         pm_runtime_put(dev);
562 
563         if (ret < 0 && ret != -ENXIO)
564                 dev_err(dev, "error %d : %x\n", ret, priv->flags);
565 
566         return ret;
567 }
568 
569 static int rcar_reg_slave(struct i2c_client *slave)
570 {
571         struct rcar_i2c_priv *priv = i2c_get_adapdata(slave->adapter);
572 
573         if (priv->slave)
574                 return -EBUSY;
575 
576         if (slave->flags & I2C_CLIENT_TEN)
577                 return -EAFNOSUPPORT;
578 
579         pm_runtime_forbid(rcar_i2c_priv_to_dev(priv));
580 
581         priv->slave = slave;
582         rcar_i2c_write(priv, ICSAR, slave->addr);
583         rcar_i2c_write(priv, ICSSR, 0);
584         rcar_i2c_write(priv, ICSIER, SAR | SSR);
585         rcar_i2c_write(priv, ICSCR, SIE | SDBS);
586 
587         return 0;
588 }
589 
590 static int rcar_unreg_slave(struct i2c_client *slave)
591 {
592         struct rcar_i2c_priv *priv = i2c_get_adapdata(slave->adapter);
593 
594         WARN_ON(!priv->slave);
595 
596         rcar_i2c_write(priv, ICSIER, 0);
597         rcar_i2c_write(priv, ICSCR, 0);
598 
599         priv->slave = NULL;
600 
601         pm_runtime_allow(rcar_i2c_priv_to_dev(priv));
602 
603         return 0;
604 }
605 
606 static u32 rcar_i2c_func(struct i2c_adapter *adap)
607 {
608         /* This HW can't do SMBUS_QUICK and NOSTART */
609         return I2C_FUNC_I2C | (I2C_FUNC_SMBUS_EMUL & ~I2C_FUNC_SMBUS_QUICK);
610 }
611 
612 static const struct i2c_algorithm rcar_i2c_algo = {
613         .master_xfer    = rcar_i2c_master_xfer,
614         .functionality  = rcar_i2c_func,
615         .reg_slave      = rcar_reg_slave,
616         .unreg_slave    = rcar_unreg_slave,
617 };
618 
619 static const struct of_device_id rcar_i2c_dt_ids[] = {
620         { .compatible = "renesas,i2c-rcar", .data = (void *)I2C_RCAR_GEN1 },
621         { .compatible = "renesas,i2c-r8a7778", .data = (void *)I2C_RCAR_GEN1 },
622         { .compatible = "renesas,i2c-r8a7779", .data = (void *)I2C_RCAR_GEN1 },
623         { .compatible = "renesas,i2c-r8a7790", .data = (void *)I2C_RCAR_GEN2 },
624         { .compatible = "renesas,i2c-r8a7791", .data = (void *)I2C_RCAR_GEN2 },
625         { .compatible = "renesas,i2c-r8a7792", .data = (void *)I2C_RCAR_GEN2 },
626         { .compatible = "renesas,i2c-r8a7793", .data = (void *)I2C_RCAR_GEN2 },
627         { .compatible = "renesas,i2c-r8a7794", .data = (void *)I2C_RCAR_GEN2 },
628         {},
629 };
630 MODULE_DEVICE_TABLE(of, rcar_i2c_dt_ids);
631 
632 static int rcar_i2c_probe(struct platform_device *pdev)
633 {
634         struct i2c_rcar_platform_data *pdata = dev_get_platdata(&pdev->dev);
635         struct rcar_i2c_priv *priv;
636         struct i2c_adapter *adap;
637         struct resource *res;
638         struct device *dev = &pdev->dev;
639         u32 bus_speed;
640         int irq, ret;
641 
642         priv = devm_kzalloc(dev, sizeof(struct rcar_i2c_priv), GFP_KERNEL);
643         if (!priv)
644                 return -ENOMEM;
645 
646         priv->clk = devm_clk_get(dev, NULL);
647         if (IS_ERR(priv->clk)) {
648                 dev_err(dev, "cannot get clock\n");
649                 return PTR_ERR(priv->clk);
650         }
651 
652         bus_speed = 100000; /* default 100 kHz */
653         ret = of_property_read_u32(dev->of_node, "clock-frequency", &bus_speed);
654         if (ret < 0 && pdata && pdata->bus_speed)
655                 bus_speed = pdata->bus_speed;
656 
657         if (pdev->dev.of_node)
658                 priv->devtype = (long)of_match_device(rcar_i2c_dt_ids,
659                                                       dev)->data;
660         else
661                 priv->devtype = platform_get_device_id(pdev)->driver_data;
662 
663         ret = rcar_i2c_clock_calculate(priv, bus_speed, dev);
664         if (ret < 0)
665                 return ret;
666 
667         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
668         priv->io = devm_ioremap_resource(dev, res);
669         if (IS_ERR(priv->io))
670                 return PTR_ERR(priv->io);
671 
672         irq = platform_get_irq(pdev, 0);
673         init_waitqueue_head(&priv->wait);
674         spin_lock_init(&priv->lock);
675 
676         adap = &priv->adap;
677         adap->nr = pdev->id;
678         adap->algo = &rcar_i2c_algo;
679         adap->class = I2C_CLASS_DEPRECATED;
680         adap->retries = 3;
681         adap->dev.parent = dev;
682         adap->dev.of_node = dev->of_node;
683         i2c_set_adapdata(adap, priv);
684         strlcpy(adap->name, pdev->name, sizeof(adap->name));
685 
686         ret = devm_request_irq(dev, irq, rcar_i2c_irq, 0,
687                                dev_name(dev), priv);
688         if (ret < 0) {
689                 dev_err(dev, "cannot get irq %d\n", irq);
690                 return ret;
691         }
692 
693         ret = i2c_add_numbered_adapter(adap);
694         if (ret < 0) {
695                 dev_err(dev, "reg adap failed: %d\n", ret);
696                 return ret;
697         }
698 
699         pm_runtime_enable(dev);
700         platform_set_drvdata(pdev, priv);
701 
702         dev_info(dev, "probed\n");
703 
704         return 0;
705 }
706 
707 static int rcar_i2c_remove(struct platform_device *pdev)
708 {
709         struct rcar_i2c_priv *priv = platform_get_drvdata(pdev);
710         struct device *dev = &pdev->dev;
711 
712         i2c_del_adapter(&priv->adap);
713         pm_runtime_disable(dev);
714 
715         return 0;
716 }
717 
718 static struct platform_device_id rcar_i2c_id_table[] = {
719         { "i2c-rcar",           I2C_RCAR_GEN1 },
720         { "i2c-rcar_gen1",      I2C_RCAR_GEN1 },
721         { "i2c-rcar_gen2",      I2C_RCAR_GEN2 },
722         {},
723 };
724 MODULE_DEVICE_TABLE(platform, rcar_i2c_id_table);
725 
726 static struct platform_driver rcar_i2c_driver = {
727         .driver = {
728                 .name   = "i2c-rcar",
729                 .of_match_table = rcar_i2c_dt_ids,
730         },
731         .probe          = rcar_i2c_probe,
732         .remove         = rcar_i2c_remove,
733         .id_table       = rcar_i2c_id_table,
734 };
735 
736 module_platform_driver(rcar_i2c_driver);
737 
738 MODULE_LICENSE("GPL v2");
739 MODULE_DESCRIPTION("Renesas R-Car I2C bus driver");
740 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
741 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us