Lines Matching full:i2c
3 * Ingenic JZ4780 I2C bus driver
14 #include <linux/i2c.h>
170 static inline unsigned short jz4780_i2c_readw(struct jz4780_i2c *i2c, in jz4780_i2c_readw() argument
173 return readw(i2c->iomem + offset); in jz4780_i2c_readw()
176 static inline void jz4780_i2c_writew(struct jz4780_i2c *i2c, in jz4780_i2c_writew() argument
179 writew(val, i2c->iomem + offset); in jz4780_i2c_writew()
182 static int jz4780_i2c_disable(struct jz4780_i2c *i2c) in jz4780_i2c_disable() argument
187 jz4780_i2c_writew(i2c, JZ4780_I2C_ENB, 0); in jz4780_i2c_disable()
190 regval = jz4780_i2c_readw(i2c, JZ4780_I2C_ENSTA); in jz4780_i2c_disable()
197 dev_err(&i2c->adap.dev, "disable failed: ENSTA=0x%04x\n", regval); in jz4780_i2c_disable()
201 static int jz4780_i2c_enable(struct jz4780_i2c *i2c) in jz4780_i2c_enable() argument
206 jz4780_i2c_writew(i2c, JZ4780_I2C_ENB, 1); in jz4780_i2c_enable()
209 regval = jz4780_i2c_readw(i2c, JZ4780_I2C_ENSTA); in jz4780_i2c_enable()
216 dev_err(&i2c->adap.dev, "enable failed: ENSTA=0x%04x\n", regval); in jz4780_i2c_enable()
220 static int jz4780_i2c_set_target(struct jz4780_i2c *i2c, unsigned char address) in jz4780_i2c_set_target() argument
226 regval = jz4780_i2c_readw(i2c, JZ4780_I2C_STA); in jz4780_i2c_set_target()
235 jz4780_i2c_writew(i2c, JZ4780_I2C_TAR, address); in jz4780_i2c_set_target()
239 dev_err(&i2c->adap.dev, in jz4780_i2c_set_target()
246 static int jz4780_i2c_set_speed(struct jz4780_i2c *i2c) in jz4780_i2c_set_speed() argument
248 int dev_clk_khz = clk_get_rate(i2c->clk) / 1000; in jz4780_i2c_set_speed()
255 int i2c_clk = i2c->speed; in jz4780_i2c_set_speed()
257 if (jz4780_i2c_disable(i2c)) in jz4780_i2c_set_speed()
258 dev_dbg(&i2c->adap.dev, "i2c not disabled\n"); in jz4780_i2c_set_speed()
275 * NOTE: JZ4780_I2C_CTRL_REST can't set when i2c enabled, because in jz4780_i2c_set_speed()
276 * normal read are 2 messages, we cannot disable i2c controller in jz4780_i2c_set_speed()
284 jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp); in jz4780_i2c_set_speed()
286 jz4780_i2c_writew(i2c, JZ4780_I2C_SHCNT, in jz4780_i2c_set_speed()
288 jz4780_i2c_writew(i2c, JZ4780_I2C_SLCNT, in jz4780_i2c_set_speed()
293 jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp); in jz4780_i2c_set_speed()
295 jz4780_i2c_writew(i2c, JZ4780_I2C_FHCNT, in jz4780_i2c_set_speed()
297 jz4780_i2c_writew(i2c, JZ4780_I2C_FLCNT, in jz4780_i2c_set_speed()
302 * a i2c device must internally provide a hold time at least 300ns in jz4780_i2c_set_speed()
336 jz4780_i2c_writew(i2c, JZ4780_I2C_SDASU, setup_time); in jz4780_i2c_set_speed()
342 /*i2c hold time enable */ in jz4780_i2c_set_speed()
344 jz4780_i2c_writew(i2c, JZ4780_I2C_SDAHD, hold_time); in jz4780_i2c_set_speed()
347 jz4780_i2c_writew(i2c, JZ4780_I2C_SDAHD, 0); in jz4780_i2c_set_speed()
353 static int jz4780_i2c_cleanup(struct jz4780_i2c *i2c) in jz4780_i2c_cleanup() argument
359 spin_lock_irqsave(&i2c->lock, flags); in jz4780_i2c_cleanup()
362 tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL); in jz4780_i2c_cleanup()
364 jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp); in jz4780_i2c_cleanup()
367 jz4780_i2c_writew(i2c, JZ4780_I2C_INTM, 0); in jz4780_i2c_cleanup()
370 jz4780_i2c_readw(i2c, JZ4780_I2C_CTXABRT); in jz4780_i2c_cleanup()
371 jz4780_i2c_readw(i2c, JZ4780_I2C_CINTR); in jz4780_i2c_cleanup()
374 tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL); in jz4780_i2c_cleanup()
376 jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp); in jz4780_i2c_cleanup()
379 jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp); in jz4780_i2c_cleanup()
381 spin_unlock_irqrestore(&i2c->lock, flags); in jz4780_i2c_cleanup()
383 ret = jz4780_i2c_disable(i2c); in jz4780_i2c_cleanup()
385 dev_err(&i2c->adap.dev, in jz4780_i2c_cleanup()
388 if (unlikely(jz4780_i2c_readw(i2c, JZ4780_I2C_INTM) in jz4780_i2c_cleanup()
389 & jz4780_i2c_readw(i2c, JZ4780_I2C_INTST))) in jz4780_i2c_cleanup()
390 dev_err(&i2c->adap.dev, in jz4780_i2c_cleanup()
396 static int jz4780_i2c_prepare(struct jz4780_i2c *i2c) in jz4780_i2c_prepare() argument
398 jz4780_i2c_set_speed(i2c); in jz4780_i2c_prepare()
399 return jz4780_i2c_enable(i2c); in jz4780_i2c_prepare()
402 static void jz4780_i2c_send_rcmd(struct jz4780_i2c *i2c, int cmd_count) in jz4780_i2c_send_rcmd() argument
407 jz4780_i2c_writew(i2c, JZ4780_I2C_DC, JZ4780_I2C_DC_READ); in jz4780_i2c_send_rcmd()
410 static void jz4780_i2c_trans_done(struct jz4780_i2c *i2c) in jz4780_i2c_trans_done() argument
412 jz4780_i2c_writew(i2c, JZ4780_I2C_INTM, 0); in jz4780_i2c_trans_done()
413 complete(&i2c->trans_waitq); in jz4780_i2c_trans_done()
421 struct jz4780_i2c *i2c = dev_id; in jz4780_i2c_irq() local
424 spin_lock_irqsave(&i2c->lock, flags); in jz4780_i2c_irq()
425 intmsk = jz4780_i2c_readw(i2c, JZ4780_I2C_INTM); in jz4780_i2c_irq()
426 intst = jz4780_i2c_readw(i2c, JZ4780_I2C_INTST); in jz4780_i2c_irq()
431 jz4780_i2c_trans_done(i2c); in jz4780_i2c_irq()
436 dev_dbg(&i2c->adap.dev, "received fifo overflow!\n"); in jz4780_i2c_irq()
437 jz4780_i2c_trans_done(i2c); in jz4780_i2c_irq()
445 if (i2c->is_write == 0) { in jz4780_i2c_irq()
448 while ((jz4780_i2c_readw(i2c, JZ4780_I2C_STA) in jz4780_i2c_irq()
450 *(i2c->rbuf++) = jz4780_i2c_readw(i2c, JZ4780_I2C_DC) in jz4780_i2c_irq()
452 i2c->rd_data_xfered++; in jz4780_i2c_irq()
453 if (i2c->rd_data_xfered == i2c->rd_total_len) { in jz4780_i2c_irq()
454 jz4780_i2c_trans_done(i2c); in jz4780_i2c_irq()
459 rd_left = i2c->rd_total_len - i2c->rd_data_xfered; in jz4780_i2c_irq()
462 jz4780_i2c_writew(i2c, JZ4780_I2C_RXTL, rd_left - 1); in jz4780_i2c_irq()
466 if (i2c->is_write == 0) { in jz4780_i2c_irq()
467 int cmd_left = i2c->rd_total_len - i2c->rd_cmd_xfered; in jz4780_i2c_irq()
469 - (i2c->rd_cmd_xfered in jz4780_i2c_irq()
470 - i2c->rd_data_xfered); in jz4780_i2c_irq()
473 if (i2c->rd_cmd_xfered != 0) in jz4780_i2c_irq()
479 jz4780_i2c_send_rcmd(i2c, cmd_to_send); in jz4780_i2c_irq()
480 i2c->rd_cmd_xfered += cmd_to_send; in jz4780_i2c_irq()
483 cmd_left = i2c->rd_total_len - i2c->rd_cmd_xfered; in jz4780_i2c_irq()
485 intmsk = jz4780_i2c_readw(i2c, JZ4780_I2C_INTM); in jz4780_i2c_irq()
487 jz4780_i2c_writew(i2c, JZ4780_I2C_INTM, intmsk); in jz4780_i2c_irq()
489 tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL); in jz4780_i2c_irq()
491 jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp); in jz4780_i2c_irq()
497 i2c_sta = jz4780_i2c_readw(i2c, JZ4780_I2C_STA); in jz4780_i2c_irq()
500 (i2c->wt_len > 0)) { in jz4780_i2c_irq()
501 i2c_sta = jz4780_i2c_readw(i2c, JZ4780_I2C_STA); in jz4780_i2c_irq()
502 data = *i2c->wbuf; in jz4780_i2c_irq()
504 jz4780_i2c_writew(i2c, JZ4780_I2C_DC, in jz4780_i2c_irq()
506 i2c->wbuf++; in jz4780_i2c_irq()
507 i2c->wt_len--; in jz4780_i2c_irq()
510 if (i2c->wt_len == 0) { in jz4780_i2c_irq()
511 if (!i2c->stop_hold) { in jz4780_i2c_irq()
512 tmp = jz4780_i2c_readw(i2c, in jz4780_i2c_irq()
515 jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, in jz4780_i2c_irq()
519 jz4780_i2c_trans_done(i2c); in jz4780_i2c_irq()
526 spin_unlock_irqrestore(&i2c->lock, flags); in jz4780_i2c_irq()
530 static void jz4780_i2c_txabrt(struct jz4780_i2c *i2c, int src) in jz4780_i2c_txabrt() argument
534 dev_err(&i2c->adap.dev, "txabrt: 0x%08x\n", src); in jz4780_i2c_txabrt()
535 dev_err(&i2c->adap.dev, "device addr=%x\n", in jz4780_i2c_txabrt()
536 jz4780_i2c_readw(i2c, JZ4780_I2C_TAR)); in jz4780_i2c_txabrt()
537 dev_err(&i2c->adap.dev, "send cmd count:%d %d\n", in jz4780_i2c_txabrt()
538 i2c->cmd, i2c->cmd_buf[i2c->cmd]); in jz4780_i2c_txabrt()
539 dev_err(&i2c->adap.dev, "receive data count:%d %d\n", in jz4780_i2c_txabrt()
540 i2c->cmd, i2c->data_buf[i2c->cmd]); in jz4780_i2c_txabrt()
544 dev_dbg(&i2c->adap.dev, "I2C TXABRT[%d]=%s\n", in jz4780_i2c_txabrt()
549 static inline int jz4780_i2c_xfer_read(struct jz4780_i2c *i2c, in jz4780_i2c_xfer_read() argument
561 spin_lock_irqsave(&i2c->lock, flags); in jz4780_i2c_xfer_read()
563 i2c->stop_hold = 0; in jz4780_i2c_xfer_read()
564 i2c->is_write = 0; in jz4780_i2c_xfer_read()
565 i2c->rbuf = buf; in jz4780_i2c_xfer_read()
566 i2c->rd_total_len = len; in jz4780_i2c_xfer_read()
567 i2c->rd_data_xfered = 0; in jz4780_i2c_xfer_read()
568 i2c->rd_cmd_xfered = 0; in jz4780_i2c_xfer_read()
571 jz4780_i2c_writew(i2c, JZ4780_I2C_RXTL, len - 1); in jz4780_i2c_xfer_read()
573 jz4780_i2c_writew(i2c, JZ4780_I2C_RXTL, RX_LEVEL); in jz4780_i2c_xfer_read()
575 jz4780_i2c_writew(i2c, JZ4780_I2C_TXTL, TX_LEVEL); in jz4780_i2c_xfer_read()
577 jz4780_i2c_writew(i2c, JZ4780_I2C_INTM, in jz4780_i2c_xfer_read()
581 tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL); in jz4780_i2c_xfer_read()
583 jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp); in jz4780_i2c_xfer_read()
585 spin_unlock_irqrestore(&i2c->lock, flags); in jz4780_i2c_xfer_read()
587 timeout = wait_for_completion_timeout(&i2c->trans_waitq, in jz4780_i2c_xfer_read()
591 dev_err(&i2c->adap.dev, "irq read timeout\n"); in jz4780_i2c_xfer_read()
592 dev_dbg(&i2c->adap.dev, "send cmd count:%d %d\n", in jz4780_i2c_xfer_read()
593 i2c->cmd, i2c->cmd_buf[i2c->cmd]); in jz4780_i2c_xfer_read()
594 dev_dbg(&i2c->adap.dev, "receive data count:%d %d\n", in jz4780_i2c_xfer_read()
595 i2c->cmd, i2c->data_buf[i2c->cmd]); in jz4780_i2c_xfer_read()
599 tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_TXABRT); in jz4780_i2c_xfer_read()
601 jz4780_i2c_txabrt(i2c, tmp); in jz4780_i2c_xfer_read()
608 static inline int jz4780_i2c_xfer_write(struct jz4780_i2c *i2c, in jz4780_i2c_xfer_write() argument
618 spin_lock_irqsave(&i2c->lock, flags); in jz4780_i2c_xfer_write()
621 i2c->stop_hold = 1; in jz4780_i2c_xfer_write()
623 i2c->stop_hold = 0; in jz4780_i2c_xfer_write()
625 i2c->is_write = 1; in jz4780_i2c_xfer_write()
626 i2c->wbuf = buf; in jz4780_i2c_xfer_write()
627 i2c->wt_len = len; in jz4780_i2c_xfer_write()
629 jz4780_i2c_writew(i2c, JZ4780_I2C_TXTL, TX_LEVEL); in jz4780_i2c_xfer_write()
631 jz4780_i2c_writew(i2c, JZ4780_I2C_INTM, JZ4780_I2C_INTM_MTXEMP in jz4780_i2c_xfer_write()
634 tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL); in jz4780_i2c_xfer_write()
636 jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp); in jz4780_i2c_xfer_write()
638 spin_unlock_irqrestore(&i2c->lock, flags); in jz4780_i2c_xfer_write()
640 timeout = wait_for_completion_timeout(&i2c->trans_waitq, in jz4780_i2c_xfer_write()
642 if (timeout && !i2c->stop_hold) { in jz4780_i2c_xfer_write()
648 i2c_sta = jz4780_i2c_readw(i2c, JZ4780_I2C_STA); in jz4780_i2c_xfer_write()
659 dev_err(&i2c->adap.dev, "write wait timeout\n"); in jz4780_i2c_xfer_write()
663 tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_TXABRT); in jz4780_i2c_xfer_write()
665 jz4780_i2c_txabrt(i2c, tmp); in jz4780_i2c_xfer_write()
677 struct jz4780_i2c *i2c = adap->algo_data; in jz4780_i2c_xfer() local
679 ret = jz4780_i2c_prepare(i2c); in jz4780_i2c_xfer()
681 dev_err(&i2c->adap.dev, "I2C prepare failed\n"); in jz4780_i2c_xfer()
685 if (msg->addr != jz4780_i2c_readw(i2c, JZ4780_I2C_TAR)) { in jz4780_i2c_xfer()
686 ret = jz4780_i2c_set_target(i2c, msg->addr); in jz4780_i2c_xfer()
692 ret = jz4780_i2c_xfer_read(i2c, msg->buf, msg->len, in jz4780_i2c_xfer()
695 ret = jz4780_i2c_xfer_write(i2c, msg->buf, msg->len, in jz4780_i2c_xfer()
705 jz4780_i2c_cleanup(i2c); in jz4780_i2c_xfer()
720 { .compatible = "ingenic,jz4780-i2c", },
731 struct jz4780_i2c *i2c; in jz4780_i2c_probe() local
733 i2c = devm_kzalloc(&pdev->dev, sizeof(struct jz4780_i2c), GFP_KERNEL); in jz4780_i2c_probe()
734 if (!i2c) in jz4780_i2c_probe()
737 i2c->adap.owner = THIS_MODULE; in jz4780_i2c_probe()
738 i2c->adap.algo = &jz4780_i2c_algorithm; in jz4780_i2c_probe()
739 i2c->adap.algo_data = i2c; in jz4780_i2c_probe()
740 i2c->adap.retries = 5; in jz4780_i2c_probe()
741 i2c->adap.dev.parent = &pdev->dev; in jz4780_i2c_probe()
742 i2c->adap.dev.of_node = pdev->dev.of_node; in jz4780_i2c_probe()
743 sprintf(i2c->adap.name, "%s", pdev->name); in jz4780_i2c_probe()
745 init_completion(&i2c->trans_waitq); in jz4780_i2c_probe()
746 spin_lock_init(&i2c->lock); in jz4780_i2c_probe()
749 i2c->iomem = devm_ioremap_resource(&pdev->dev, r); in jz4780_i2c_probe()
750 if (IS_ERR(i2c->iomem)) in jz4780_i2c_probe()
751 return PTR_ERR(i2c->iomem); in jz4780_i2c_probe()
753 platform_set_drvdata(pdev, i2c); in jz4780_i2c_probe()
755 i2c->clk = devm_clk_get(&pdev->dev, NULL); in jz4780_i2c_probe()
756 if (IS_ERR(i2c->clk)) in jz4780_i2c_probe()
757 return PTR_ERR(i2c->clk); in jz4780_i2c_probe()
759 ret = clk_prepare_enable(i2c->clk); in jz4780_i2c_probe()
770 i2c->speed = clk_freq / 1000; in jz4780_i2c_probe()
771 if (i2c->speed == 0) { in jz4780_i2c_probe()
776 jz4780_i2c_set_speed(i2c); in jz4780_i2c_probe()
778 dev_info(&pdev->dev, "Bus frequency is %d KHz\n", i2c->speed); in jz4780_i2c_probe()
780 tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL); in jz4780_i2c_probe()
782 jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp); in jz4780_i2c_probe()
784 jz4780_i2c_writew(i2c, JZ4780_I2C_INTM, 0x0); in jz4780_i2c_probe()
786 i2c->irq = platform_get_irq(pdev, 0); in jz4780_i2c_probe()
787 ret = devm_request_irq(&pdev->dev, i2c->irq, jz4780_i2c_irq, 0, in jz4780_i2c_probe()
788 dev_name(&pdev->dev), i2c); in jz4780_i2c_probe()
792 ret = i2c_add_adapter(&i2c->adap); in jz4780_i2c_probe()
799 clk_disable_unprepare(i2c->clk); in jz4780_i2c_probe()
805 struct jz4780_i2c *i2c = platform_get_drvdata(pdev); in jz4780_i2c_remove() local
807 clk_disable_unprepare(i2c->clk); in jz4780_i2c_remove()
808 i2c_del_adapter(&i2c->adap); in jz4780_i2c_remove()
816 .name = "jz4780-i2c",
825 MODULE_DESCRIPTION("i2c driver for JZ4780 SoCs");