Lines Matching +full:mclk +full:- +full:id
4 * (c) 2005-2008 MSC Vertriebsges.m.b.H, Manuel Lauss <mlau@msc-ge.com>
22 #include <asm/i2c-sh7760.h>
43 #define MCR_MDBS 0x80 /* non-fifo mode switch */
104 __raw_writel(val, (unsigned long)cam->iobase + reg); in OUT32()
109 return __raw_readl((unsigned long)cam->iobase + reg); in IN32()
114 struct cami2c *id = ptr; in sh7760_i2c_irq() local
115 struct i2c_msg *msg = id->msg; in sh7760_i2c_irq()
116 char *data = msg->buf; in sh7760_i2c_irq()
119 msr = IN32(id, I2CMSR); in sh7760_i2c_irq()
120 fsr = IN32(id, I2CFSR); in sh7760_i2c_irq()
124 OUT32(id, I2CMCR, 0); in sh7760_i2c_irq()
125 OUT32(id, I2CSCR, 0); in sh7760_i2c_irq()
126 OUT32(id, I2CSAR, 0); in sh7760_i2c_irq()
127 id->status |= IDS_DONE | IDS_ARBLOST; in sh7760_i2c_irq()
139 OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST); in sh7760_i2c_irq()
140 OUT32(id, I2CMCR, MCR_MIE | MCR_FSB); in sh7760_i2c_irq()
141 OUT32(id, I2CFIER, 0); in sh7760_i2c_irq()
142 OUT32(id, I2CMIER, MIE_MSTE); in sh7760_i2c_irq()
143 OUT32(id, I2CSCR, 0); in sh7760_i2c_irq()
144 OUT32(id, I2CSAR, 0); in sh7760_i2c_irq()
145 id->status |= IDS_NACK; in sh7760_i2c_irq()
151 /* i2c-stop was sent */ in sh7760_i2c_irq()
153 id->status |= IDS_DONE; in sh7760_i2c_irq()
159 OUT32(id, I2CMCR, MCR_MIE); in sh7760_i2c_irq()
161 fier = IN32(id, I2CFIER); in sh7760_i2c_irq()
164 len = IN32(id, I2CRFDR); in sh7760_i2c_irq()
165 if (msg->len <= len) { in sh7760_i2c_irq()
166 if (id->flags & IDF_STOP) { in sh7760_i2c_irq()
167 OUT32(id, I2CMCR, MCR_MIE | MCR_FSB); in sh7760_i2c_irq()
168 OUT32(id, I2CFIER, 0); in sh7760_i2c_irq()
173 id->status |= IDS_DONE; in sh7760_i2c_irq()
181 while (msg->len && len) { in sh7760_i2c_irq()
182 *data++ = IN32(id, I2CRXTX); in sh7760_i2c_irq()
183 msg->len--; in sh7760_i2c_irq()
184 len--; in sh7760_i2c_irq()
187 if (msg->len) { in sh7760_i2c_irq()
188 len = (msg->len >= FIFO_SIZE) ? FIFO_SIZE - 1 in sh7760_i2c_irq()
189 : msg->len - 1; in sh7760_i2c_irq()
191 OUT32(id, I2CFCR, FCR_TFRST | ((len & 0xf) << 4)); in sh7760_i2c_irq()
194 } else if (id->flags & IDF_SEND) { in sh7760_i2c_irq()
195 if ((fsr & FSR_TEND) && (msg->len < 1)) { in sh7760_i2c_irq()
196 if (id->flags & IDF_STOP) { in sh7760_i2c_irq()
197 OUT32(id, I2CMCR, MCR_MIE | MCR_FSB); in sh7760_i2c_irq()
199 id->status |= IDS_DONE; in sh7760_i2c_irq()
208 while (msg->len && (IN32(id, I2CTFDR) < FIFO_SIZE)) { in sh7760_i2c_irq()
209 OUT32(id, I2CRXTX, *data++); in sh7760_i2c_irq()
210 msg->len--; in sh7760_i2c_irq()
213 if (msg->len < 1) { in sh7760_i2c_irq()
215 OUT32(id, I2CFIER, fier); in sh7760_i2c_irq()
217 len = (msg->len >= FIFO_SIZE) ? 2 : 0; in sh7760_i2c_irq()
218 OUT32(id, I2CFCR, in sh7760_i2c_irq()
224 if (id->status & IDS_DONE) { in sh7760_i2c_irq()
225 OUT32(id, I2CMIER, 0); in sh7760_i2c_irq()
226 OUT32(id, I2CFIER, 0); in sh7760_i2c_irq()
227 id->msg = NULL; in sh7760_i2c_irq()
228 complete(&id->xfer_done); in sh7760_i2c_irq()
231 OUT32(id, I2CMSR, ~msr); in sh7760_i2c_irq()
232 OUT32(id, I2CFSR, ~fsr); in sh7760_i2c_irq()
233 OUT32(id, I2CSSR, 0); in sh7760_i2c_irq()
240 static void sh7760_i2c_mrecv(struct cami2c *id) in sh7760_i2c_mrecv() argument
244 id->flags |= IDF_RECV; in sh7760_i2c_mrecv()
247 OUT32(id, I2CSAR, 0xfe); in sh7760_i2c_mrecv()
248 OUT32(id, I2CMAR, (id->msg->addr << 1) | 1); in sh7760_i2c_mrecv()
251 if (id->msg->len >= FIFO_SIZE) in sh7760_i2c_mrecv()
252 len = FIFO_SIZE - 1; /* trigger at fifo full */ in sh7760_i2c_mrecv()
254 len = id->msg->len - 1; /* trigger before all received */ in sh7760_i2c_mrecv()
256 OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST); in sh7760_i2c_mrecv()
257 OUT32(id, I2CFCR, FCR_TFRST | ((len & 0xF) << 4)); in sh7760_i2c_mrecv()
259 OUT32(id, I2CMSR, 0); in sh7760_i2c_mrecv()
260 OUT32(id, I2CMCR, MCR_MIE | MCR_ESG); in sh7760_i2c_mrecv()
261 OUT32(id, I2CMIER, MIE_MNRE | MIE_MALE | MIE_MSTE | MIE_MATE); in sh7760_i2c_mrecv()
262 OUT32(id, I2CFIER, FIER_RXIE); in sh7760_i2c_mrecv()
266 static void sh7760_i2c_msend(struct cami2c *id) in sh7760_i2c_msend() argument
270 id->flags |= IDF_SEND; in sh7760_i2c_msend()
273 OUT32(id, I2CSAR, 0xfe); in sh7760_i2c_msend()
274 OUT32(id, I2CMAR, (id->msg->addr << 1) | 0); in sh7760_i2c_msend()
277 if (id->msg->len >= FIFO_SIZE) in sh7760_i2c_msend()
282 OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST); in sh7760_i2c_msend()
283 OUT32(id, I2CFCR, FCR_RFRST | ((len & 3) << 2)); in sh7760_i2c_msend()
285 while (id->msg->len && IN32(id, I2CTFDR) < FIFO_SIZE) { in sh7760_i2c_msend()
286 OUT32(id, I2CRXTX, *(id->msg->buf)); in sh7760_i2c_msend()
287 (id->msg->len)--; in sh7760_i2c_msend()
288 (id->msg->buf)++; in sh7760_i2c_msend()
291 OUT32(id, I2CMSR, 0); in sh7760_i2c_msend()
292 OUT32(id, I2CMCR, MCR_MIE | MCR_ESG); in sh7760_i2c_msend()
293 OUT32(id, I2CFSR, 0); in sh7760_i2c_msend()
294 OUT32(id, I2CMIER, MIE_MNRE | MIE_MALE | MIE_MSTE | MIE_MATE); in sh7760_i2c_msend()
295 OUT32(id, I2CFIER, FIER_TEIE | (id->msg->len ? FIER_TXIE : 0)); in sh7760_i2c_msend()
298 static inline int sh7760_i2c_busy_check(struct cami2c *id) in sh7760_i2c_busy_check() argument
300 return (IN32(id, I2CMCR) & MCR_FSDA); in sh7760_i2c_busy_check()
307 struct cami2c *id = adap->algo_data; in sh7760_i2c_master_xfer() local
310 if (sh7760_i2c_busy_check(id)) { in sh7760_i2c_master_xfer()
311 dev_err(&adap->dev, "sh7760-i2c%d: bus busy!\n", adap->nr); in sh7760_i2c_master_xfer()
312 return -EBUSY; in sh7760_i2c_master_xfer()
317 retr = adap->retries; in sh7760_i2c_master_xfer()
319 id->flags = ((i == (num-1)) ? IDF_STOP : 0); in sh7760_i2c_master_xfer()
320 id->status = 0; in sh7760_i2c_master_xfer()
321 id->msg = msgs; in sh7760_i2c_master_xfer()
322 init_completion(&id->xfer_done); in sh7760_i2c_master_xfer()
324 if (msgs->flags & I2C_M_RD) in sh7760_i2c_master_xfer()
325 sh7760_i2c_mrecv(id); in sh7760_i2c_master_xfer()
327 sh7760_i2c_msend(id); in sh7760_i2c_master_xfer()
329 wait_for_completion(&id->xfer_done); in sh7760_i2c_master_xfer()
331 if (id->status == 0) { in sh7760_i2c_master_xfer()
332 num = -EIO; in sh7760_i2c_master_xfer()
336 if (id->status & IDS_NACK) { in sh7760_i2c_master_xfer()
339 num = -EREMOTEIO; in sh7760_i2c_master_xfer()
343 if (id->status & IDS_ARBLOST) { in sh7760_i2c_master_xfer()
344 if (retr--) { in sh7760_i2c_master_xfer()
348 num = -EREMOTEIO; in sh7760_i2c_master_xfer()
356 id->msg = NULL; in sh7760_i2c_master_xfer()
357 id->flags = 0; in sh7760_i2c_master_xfer()
358 id->status = 0; in sh7760_i2c_master_xfer()
360 OUT32(id, I2CMCR, 0); in sh7760_i2c_master_xfer()
361 OUT32(id, I2CMSR, 0); in sh7760_i2c_master_xfer()
362 OUT32(id, I2CMIER, 0); in sh7760_i2c_master_xfer()
363 OUT32(id, I2CFIER, 0); in sh7760_i2c_master_xfer()
369 OUT32(id, I2CSCR, 0); in sh7760_i2c_master_xfer()
370 OUT32(id, I2CSAR, 0); in sh7760_i2c_master_xfer()
371 OUT32(id, I2CSSR, 0); in sh7760_i2c_master_xfer()
388 * peripheral module clock (mclk, usually around 33MHz):
389 * iclk = mclk/(CDF + 1). iclk must be < 20MHz.
394 struct clk *mclk; in calc_CCR() local
399 mclk = clk_get(NULL, "peripheral_clk"); in calc_CCR()
400 if (IS_ERR(mclk)) { in calc_CCR()
401 return PTR_ERR(mclk); in calc_CCR()
403 mck = mclk->rate; in calc_CCR()
404 clk_put(mclk); in calc_CCR()
409 for (cdf = 3; cdf >= 0; cdf--) { in calc_CCR()
413 scgds = ((iclk / scl_hz) - 20) >> 3; in calc_CCR()
416 dff = abs(scl_hz - m1); in calc_CCR()
426 return -EINVAL; in calc_CCR()
436 struct cami2c *id; in sh7760_i2c_probe() local
439 pd = dev_get_platdata(&pdev->dev); in sh7760_i2c_probe()
441 dev_err(&pdev->dev, "no platform_data!\n"); in sh7760_i2c_probe()
442 ret = -ENODEV; in sh7760_i2c_probe()
446 id = kzalloc(sizeof(*id), GFP_KERNEL); in sh7760_i2c_probe()
447 if (!id) { in sh7760_i2c_probe()
448 ret = -ENOMEM; in sh7760_i2c_probe()
454 dev_err(&pdev->dev, "no mmio resources\n"); in sh7760_i2c_probe()
455 ret = -ENODEV; in sh7760_i2c_probe()
459 id->ioarea = request_mem_region(res->start, REGSIZE, pdev->name); in sh7760_i2c_probe()
460 if (!id->ioarea) { in sh7760_i2c_probe()
461 dev_err(&pdev->dev, "mmio already reserved\n"); in sh7760_i2c_probe()
462 ret = -EBUSY; in sh7760_i2c_probe()
466 id->iobase = ioremap(res->start, REGSIZE); in sh7760_i2c_probe()
467 if (!id->iobase) { in sh7760_i2c_probe()
468 dev_err(&pdev->dev, "cannot ioremap\n"); in sh7760_i2c_probe()
469 ret = -ENODEV; in sh7760_i2c_probe()
476 id->irq = ret; in sh7760_i2c_probe()
478 id->adap.nr = pdev->id; in sh7760_i2c_probe()
479 id->adap.algo = &sh7760_i2c_algo; in sh7760_i2c_probe()
480 id->adap.class = I2C_CLASS_HWMON; in sh7760_i2c_probe()
481 id->adap.retries = 3; in sh7760_i2c_probe()
482 id->adap.algo_data = id; in sh7760_i2c_probe()
483 id->adap.dev.parent = &pdev->dev; in sh7760_i2c_probe()
484 snprintf(id->adap.name, sizeof(id->adap.name), in sh7760_i2c_probe()
485 "SH7760 I2C at %08lx", (unsigned long)res->start); in sh7760_i2c_probe()
487 OUT32(id, I2CMCR, 0); in sh7760_i2c_probe()
488 OUT32(id, I2CMSR, 0); in sh7760_i2c_probe()
489 OUT32(id, I2CMIER, 0); in sh7760_i2c_probe()
490 OUT32(id, I2CMAR, 0); in sh7760_i2c_probe()
491 OUT32(id, I2CSIER, 0); in sh7760_i2c_probe()
492 OUT32(id, I2CSAR, 0); in sh7760_i2c_probe()
493 OUT32(id, I2CSCR, 0); in sh7760_i2c_probe()
494 OUT32(id, I2CSSR, 0); in sh7760_i2c_probe()
495 OUT32(id, I2CFIER, 0); in sh7760_i2c_probe()
496 OUT32(id, I2CFCR, FCR_RFRST | FCR_TFRST); in sh7760_i2c_probe()
497 OUT32(id, I2CFSR, 0); in sh7760_i2c_probe()
499 ret = calc_CCR(pd->speed_khz * 1000); in sh7760_i2c_probe()
501 dev_err(&pdev->dev, "invalid SCL clock: %dkHz\n", in sh7760_i2c_probe()
502 pd->speed_khz); in sh7760_i2c_probe()
505 OUT32(id, I2CCCR, ret); in sh7760_i2c_probe()
507 if (request_irq(id->irq, sh7760_i2c_irq, 0, in sh7760_i2c_probe()
508 SH7760_I2C_DEVNAME, id)) { in sh7760_i2c_probe()
509 dev_err(&pdev->dev, "cannot get irq %d\n", id->irq); in sh7760_i2c_probe()
510 ret = -EBUSY; in sh7760_i2c_probe()
514 ret = i2c_add_numbered_adapter(&id->adap); in sh7760_i2c_probe()
518 platform_set_drvdata(pdev, id); in sh7760_i2c_probe()
520 dev_info(&pdev->dev, "%d kHz mmio %08x irq %d\n", in sh7760_i2c_probe()
521 pd->speed_khz, res->start, id->irq); in sh7760_i2c_probe()
526 free_irq(id->irq, id); in sh7760_i2c_probe()
528 iounmap(id->iobase); in sh7760_i2c_probe()
530 release_resource(id->ioarea); in sh7760_i2c_probe()
531 kfree(id->ioarea); in sh7760_i2c_probe()
533 kfree(id); in sh7760_i2c_probe()
540 struct cami2c *id = platform_get_drvdata(pdev); in sh7760_i2c_remove() local
542 i2c_del_adapter(&id->adap); in sh7760_i2c_remove()
543 free_irq(id->irq, id); in sh7760_i2c_remove()
544 iounmap(id->iobase); in sh7760_i2c_remove()
545 release_resource(id->ioarea); in sh7760_i2c_remove()
546 kfree(id->ioarea); in sh7760_i2c_remove()
547 kfree(id); in sh7760_i2c_remove()