179 static inline unsigned short jz4780_i2c_readw(struct jz4780_i2c *i2c,  in jz4780_i2c_readw()  argument
182 	return readw(i2c->iomem + offset);  in jz4780_i2c_readw()
185 static inline void jz4780_i2c_writew(struct jz4780_i2c *i2c,  in jz4780_i2c_writew()  argument
188 	writew(val, i2c->iomem + offset);  in jz4780_i2c_writew()
191 static int jz4780_i2c_disable(struct jz4780_i2c *i2c)  in jz4780_i2c_disable()  argument
196 	jz4780_i2c_writew(i2c, JZ4780_I2C_ENB, 0);  in jz4780_i2c_disable()
199 		regval = jz4780_i2c_readw(i2c, JZ4780_I2C_ENSTA);  in jz4780_i2c_disable()
206 	dev_err(&i2c->adap.dev, "disable failed: ENSTA=0x%04x\n", regval);  in jz4780_i2c_disable()
210 static int jz4780_i2c_enable(struct jz4780_i2c *i2c)  in jz4780_i2c_enable()  argument
215 	jz4780_i2c_writew(i2c, JZ4780_I2C_ENB, 1);  in jz4780_i2c_enable()
218 		regval = jz4780_i2c_readw(i2c, JZ4780_I2C_ENSTA);  in jz4780_i2c_enable()
225 	dev_err(&i2c->adap.dev, "enable failed: ENSTA=0x%04x\n", regval);  in jz4780_i2c_enable()
229 static int jz4780_i2c_set_target(struct jz4780_i2c *i2c, unsigned char address)  in jz4780_i2c_set_target()  argument
235 		regval = jz4780_i2c_readw(i2c, JZ4780_I2C_STA);  in jz4780_i2c_set_target()
244 		jz4780_i2c_writew(i2c, JZ4780_I2C_TAR, address);  in jz4780_i2c_set_target()
248 	dev_err(&i2c->adap.dev,  in jz4780_i2c_set_target()
255 static int jz4780_i2c_set_speed(struct jz4780_i2c *i2c)  in jz4780_i2c_set_speed()  argument
257 	int dev_clk_khz = clk_get_rate(i2c->clk) / 1000;  in jz4780_i2c_set_speed()
264 	int i2c_clk = i2c->speed;  in jz4780_i2c_set_speed()
266 	if (jz4780_i2c_disable(i2c))  in jz4780_i2c_set_speed()
267 		dev_dbg(&i2c->adap.dev, "i2c not disabled\n");  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_SHCNT,  in jz4780_i2c_set_speed()
297 		jz4780_i2c_writew(i2c, JZ4780_I2C_SLCNT,  in jz4780_i2c_set_speed()
302 		jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp);  in jz4780_i2c_set_speed()
304 		jz4780_i2c_writew(i2c, JZ4780_I2C_FHCNT,  in jz4780_i2c_set_speed()
306 		jz4780_i2c_writew(i2c, JZ4780_I2C_FLCNT,  in jz4780_i2c_set_speed()
345 	jz4780_i2c_writew(i2c, JZ4780_I2C_SDASU, setup_time);  in jz4780_i2c_set_speed()
353 		jz4780_i2c_writew(i2c, JZ4780_I2C_SDAHD, hold_time);  in jz4780_i2c_set_speed()
356 		jz4780_i2c_writew(i2c, JZ4780_I2C_SDAHD, 0);  in jz4780_i2c_set_speed()
362 static int jz4780_i2c_cleanup(struct jz4780_i2c *i2c)  in jz4780_i2c_cleanup()  argument
368 	spin_lock_irqsave(&i2c->lock, flags);  in jz4780_i2c_cleanup()
371 	tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL);  in jz4780_i2c_cleanup()
373 	jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp);  in jz4780_i2c_cleanup()
376 	jz4780_i2c_writew(i2c, JZ4780_I2C_INTM, 0);  in jz4780_i2c_cleanup()
379 	jz4780_i2c_readw(i2c, JZ4780_I2C_CTXABRT);  in jz4780_i2c_cleanup()
380 	jz4780_i2c_readw(i2c, JZ4780_I2C_CINTR);  in jz4780_i2c_cleanup()
383 	tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL);  in jz4780_i2c_cleanup()
385 	jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp);  in jz4780_i2c_cleanup()
388 	jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp);  in jz4780_i2c_cleanup()
390 	spin_unlock_irqrestore(&i2c->lock, flags);  in jz4780_i2c_cleanup()
392 	ret = jz4780_i2c_disable(i2c);  in jz4780_i2c_cleanup()
394 		dev_err(&i2c->adap.dev,  in jz4780_i2c_cleanup()
397 	if (unlikely(jz4780_i2c_readw(i2c, JZ4780_I2C_INTM)  in jz4780_i2c_cleanup()
398 		     & jz4780_i2c_readw(i2c, JZ4780_I2C_INTST)))  in jz4780_i2c_cleanup()
399 		dev_err(&i2c->adap.dev,  in jz4780_i2c_cleanup()
405 static int jz4780_i2c_prepare(struct jz4780_i2c *i2c)  in jz4780_i2c_prepare()  argument
407 	jz4780_i2c_set_speed(i2c);  in jz4780_i2c_prepare()
408 	return jz4780_i2c_enable(i2c);  in jz4780_i2c_prepare()
411 static void jz4780_i2c_send_rcmd(struct jz4780_i2c *i2c, int cmd_count)  in jz4780_i2c_send_rcmd()  argument
416 		jz4780_i2c_writew(i2c, JZ4780_I2C_DC, JZ4780_I2C_DC_READ);  in jz4780_i2c_send_rcmd()
419 static void jz4780_i2c_trans_done(struct jz4780_i2c *i2c)  in jz4780_i2c_trans_done()  argument
421 	jz4780_i2c_writew(i2c, JZ4780_I2C_INTM, 0);  in jz4780_i2c_trans_done()
422 	complete(&i2c->trans_waitq);  in jz4780_i2c_trans_done()
430 	struct jz4780_i2c *i2c = dev_id;  in jz4780_i2c_irq()  local
433 	spin_lock_irqsave(&i2c->lock, flags);  in jz4780_i2c_irq()
434 	intmsk = jz4780_i2c_readw(i2c, JZ4780_I2C_INTM);  in jz4780_i2c_irq()
435 	intst = jz4780_i2c_readw(i2c, JZ4780_I2C_INTST);  in jz4780_i2c_irq()
440 		jz4780_i2c_trans_done(i2c);  in jz4780_i2c_irq()
445 		dev_dbg(&i2c->adap.dev, "received fifo overflow!\n");  in jz4780_i2c_irq()
446 		jz4780_i2c_trans_done(i2c);  in jz4780_i2c_irq()
454 	if (i2c->is_write == 0) {  in jz4780_i2c_irq()
457 		while ((jz4780_i2c_readw(i2c, JZ4780_I2C_STA)  in jz4780_i2c_irq()
459 			*(i2c->rbuf++) = jz4780_i2c_readw(i2c, JZ4780_I2C_DC)  in jz4780_i2c_irq()
461 			i2c->rd_data_xfered++;  in jz4780_i2c_irq()
462 			if (i2c->rd_data_xfered == i2c->rd_total_len) {  in jz4780_i2c_irq()
463 				jz4780_i2c_trans_done(i2c);  in jz4780_i2c_irq()
468 		rd_left = i2c->rd_total_len - i2c->rd_data_xfered;  in jz4780_i2c_irq()
471 			jz4780_i2c_writew(i2c, JZ4780_I2C_RXTL, rd_left - 1);  in jz4780_i2c_irq()
475 		if (i2c->is_write == 0) {  in jz4780_i2c_irq()
476 			int cmd_left = i2c->rd_total_len - i2c->rd_cmd_xfered;  in jz4780_i2c_irq()
478 					 - (i2c->rd_cmd_xfered  in jz4780_i2c_irq()
479 					 - i2c->rd_data_xfered);  in jz4780_i2c_irq()
482 			if (i2c->rd_cmd_xfered != 0)  in jz4780_i2c_irq()
488 				jz4780_i2c_send_rcmd(i2c, cmd_to_send);  in jz4780_i2c_irq()
489 				i2c->rd_cmd_xfered += cmd_to_send;  in jz4780_i2c_irq()
492 			cmd_left = i2c->rd_total_len - i2c->rd_cmd_xfered;  in jz4780_i2c_irq()
494 				intmsk = jz4780_i2c_readw(i2c, JZ4780_I2C_INTM);  in jz4780_i2c_irq()
496 				jz4780_i2c_writew(i2c, JZ4780_I2C_INTM, intmsk);  in jz4780_i2c_irq()
498 				tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL);  in jz4780_i2c_irq()
500 				jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp);  in jz4780_i2c_irq()
506 			i2c_sta = jz4780_i2c_readw(i2c, JZ4780_I2C_STA);  in jz4780_i2c_irq()
509 			       (i2c->wt_len > 0)) {  in jz4780_i2c_irq()
510 				i2c_sta = jz4780_i2c_readw(i2c, JZ4780_I2C_STA);  in jz4780_i2c_irq()
511 				data = *i2c->wbuf;  in jz4780_i2c_irq()
513 				jz4780_i2c_writew(i2c, JZ4780_I2C_DC,  in jz4780_i2c_irq()
515 				i2c->wbuf++;  in jz4780_i2c_irq()
516 				i2c->wt_len--;  in jz4780_i2c_irq()
519 			if (i2c->wt_len == 0) {  in jz4780_i2c_irq()
520 				if (!i2c->stop_hold) {  in jz4780_i2c_irq()
521 					tmp = jz4780_i2c_readw(i2c,  in jz4780_i2c_irq()
524 					jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL,  in jz4780_i2c_irq()
528 				jz4780_i2c_trans_done(i2c);  in jz4780_i2c_irq()
535 	spin_unlock_irqrestore(&i2c->lock, flags);  in jz4780_i2c_irq()
539 static void jz4780_i2c_txabrt(struct jz4780_i2c *i2c, int src)  in jz4780_i2c_txabrt()  argument
543 	dev_err(&i2c->adap.dev, "txabrt: 0x%08x\n", src);  in jz4780_i2c_txabrt()
544 	dev_err(&i2c->adap.dev, "device addr=%x\n",  in jz4780_i2c_txabrt()
545 		jz4780_i2c_readw(i2c, JZ4780_I2C_TAR));  in jz4780_i2c_txabrt()
546 	dev_err(&i2c->adap.dev, "send cmd count:%d  %d\n",  in jz4780_i2c_txabrt()
547 		i2c->cmd, i2c->cmd_buf[i2c->cmd]);  in jz4780_i2c_txabrt()
548 	dev_err(&i2c->adap.dev, "receive data count:%d  %d\n",  in jz4780_i2c_txabrt()
549 		i2c->cmd, i2c->data_buf[i2c->cmd]);  in jz4780_i2c_txabrt()
553 			dev_dbg(&i2c->adap.dev, "I2C TXABRT[%d]=%s\n",  in jz4780_i2c_txabrt()
558 static inline int jz4780_i2c_xfer_read(struct jz4780_i2c *i2c,  in jz4780_i2c_xfer_read()  argument
570 	spin_lock_irqsave(&i2c->lock, flags);  in jz4780_i2c_xfer_read()
572 	i2c->stop_hold = 0;  in jz4780_i2c_xfer_read()
573 	i2c->is_write = 0;  in jz4780_i2c_xfer_read()
574 	i2c->rbuf = buf;  in jz4780_i2c_xfer_read()
575 	i2c->rd_total_len = len;  in jz4780_i2c_xfer_read()
576 	i2c->rd_data_xfered = 0;  in jz4780_i2c_xfer_read()
577 	i2c->rd_cmd_xfered = 0;  in jz4780_i2c_xfer_read()
580 		jz4780_i2c_writew(i2c, JZ4780_I2C_RXTL, len - 1);  in jz4780_i2c_xfer_read()
582 		jz4780_i2c_writew(i2c, JZ4780_I2C_RXTL, RX_LEVEL);  in jz4780_i2c_xfer_read()
584 	jz4780_i2c_writew(i2c, JZ4780_I2C_TXTL, TX_LEVEL);  in jz4780_i2c_xfer_read()
586 	jz4780_i2c_writew(i2c, JZ4780_I2C_INTM,  in jz4780_i2c_xfer_read()
590 	tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL);  in jz4780_i2c_xfer_read()
592 	jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp);  in jz4780_i2c_xfer_read()
594 	spin_unlock_irqrestore(&i2c->lock, flags);  in jz4780_i2c_xfer_read()
596 	timeout = wait_for_completion_timeout(&i2c->trans_waitq,  in jz4780_i2c_xfer_read()
600 		dev_err(&i2c->adap.dev, "irq read timeout\n");  in jz4780_i2c_xfer_read()
601 		dev_dbg(&i2c->adap.dev, "send cmd count:%d  %d\n",  in jz4780_i2c_xfer_read()
602 			i2c->cmd, i2c->cmd_buf[i2c->cmd]);  in jz4780_i2c_xfer_read()
603 		dev_dbg(&i2c->adap.dev, "receive data count:%d  %d\n",  in jz4780_i2c_xfer_read()
604 			i2c->cmd, i2c->data_buf[i2c->cmd]);  in jz4780_i2c_xfer_read()
608 	tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_TXABRT);  in jz4780_i2c_xfer_read()
610 		jz4780_i2c_txabrt(i2c, tmp);  in jz4780_i2c_xfer_read()
617 static inline int jz4780_i2c_xfer_write(struct jz4780_i2c *i2c,  in jz4780_i2c_xfer_write()  argument
627 	spin_lock_irqsave(&i2c->lock, flags);  in jz4780_i2c_xfer_write()
630 		i2c->stop_hold = 1;  in jz4780_i2c_xfer_write()
632 		i2c->stop_hold = 0;  in jz4780_i2c_xfer_write()
634 	i2c->is_write = 1;  in jz4780_i2c_xfer_write()
635 	i2c->wbuf = buf;  in jz4780_i2c_xfer_write()
636 	i2c->wt_len = len;  in jz4780_i2c_xfer_write()
638 	jz4780_i2c_writew(i2c, JZ4780_I2C_TXTL, TX_LEVEL);  in jz4780_i2c_xfer_write()
640 	jz4780_i2c_writew(i2c, JZ4780_I2C_INTM, JZ4780_I2C_INTM_MTXEMP  in jz4780_i2c_xfer_write()
643 	tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_CTRL);  in jz4780_i2c_xfer_write()
645 	jz4780_i2c_writew(i2c, JZ4780_I2C_CTRL, tmp);  in jz4780_i2c_xfer_write()
647 	spin_unlock_irqrestore(&i2c->lock, flags);  in jz4780_i2c_xfer_write()
649 	timeout = wait_for_completion_timeout(&i2c->trans_waitq,  in jz4780_i2c_xfer_write()
651 	if (timeout && !i2c->stop_hold) {  in jz4780_i2c_xfer_write()
657 			i2c_sta = jz4780_i2c_readw(i2c, JZ4780_I2C_STA);  in jz4780_i2c_xfer_write()
668 		dev_err(&i2c->adap.dev, "write wait timeout\n");  in jz4780_i2c_xfer_write()
672 	tmp = jz4780_i2c_readw(i2c, JZ4780_I2C_TXABRT);  in jz4780_i2c_xfer_write()
674 		jz4780_i2c_txabrt(i2c, tmp);  in jz4780_i2c_xfer_write()
686 	struct jz4780_i2c *i2c = adap->algo_data;  in jz4780_i2c_xfer()  local
688 	ret = jz4780_i2c_prepare(i2c);  in jz4780_i2c_xfer()
690 		dev_err(&i2c->adap.dev, "I2C prepare failed\n");  in jz4780_i2c_xfer()
694 	if (msg->addr != jz4780_i2c_readw(i2c, JZ4780_I2C_TAR)) {  in jz4780_i2c_xfer()
695 		ret = jz4780_i2c_set_target(i2c, msg->addr);  in jz4780_i2c_xfer()
701 			ret = jz4780_i2c_xfer_read(i2c, msg->buf, msg->len,  in jz4780_i2c_xfer()
704 			ret = jz4780_i2c_xfer_write(i2c, msg->buf, msg->len,  in jz4780_i2c_xfer()
714 	jz4780_i2c_cleanup(i2c);  in jz4780_i2c_xfer()
739 	struct jz4780_i2c *i2c;  in jz4780_i2c_probe()  local
741 	i2c = devm_kzalloc(&pdev->dev, sizeof(struct jz4780_i2c), GFP_KERNEL);  in jz4780_i2c_probe()
742 	if (!i2c)  in jz4780_i2c_probe()
745 	i2c->adap.owner		= THIS_MODULE;  in jz4780_i2c_probe()
746 	i2c->adap.algo		= &jz4780_i2c_algorithm;  in jz4780_i2c_probe()
747 	i2c->adap.algo_data	= i2c;  in jz4780_i2c_probe()
748 	i2c->adap.retries	= 5;  in jz4780_i2c_probe()
749 	i2c->adap.dev.parent	= &pdev->dev;  in jz4780_i2c_probe()
750 	i2c->adap.dev.of_node	= pdev->dev.of_node;  in jz4780_i2c_probe()
751 	sprintf(i2c->adap.name, "%s", pdev->name);  in jz4780_i2c_probe()
753 	init_completion(&i2c->trans_waitq);  in jz4780_i2c_probe()
754 	spin_lock_init(&i2c->lock);  in jz4780_i2c_probe()
757 	i2c->iomem = devm_ioremap_resource(&pdev->dev, r);  in jz4780_i2c_probe()
758 	if (IS_ERR(i2c->iomem))  in jz4780_i2c_probe()
759 		return PTR_ERR(i2c->iomem);  in jz4780_i2c_probe()
761 	platform_set_drvdata(pdev, i2c);  in jz4780_i2c_probe()
763 	i2c->clk = devm_clk_get(&pdev->dev, NULL);  in jz4780_i2c_probe()
764 	if (IS_ERR(i2c->clk))  in jz4780_i2c_probe()
765 		return PTR_ERR(i2c->clk);  in jz4780_i2c_probe()
767 	clk_prepare_enable(i2c->clk);  in jz4780_i2c_probe()
775 	i2c->speed = clk_freq / 1000;  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->cmd = 0;  in jz4780_i2c_probe()
787 	memset(i2c->cmd_buf, 0, BUFSIZE);  in jz4780_i2c_probe()
788 	memset(i2c->data_buf, 0, BUFSIZE);  in jz4780_i2c_probe()
790 	i2c->irq = platform_get_irq(pdev, 0);  in jz4780_i2c_probe()
791 	ret = devm_request_irq(&pdev->dev, i2c->irq, jz4780_i2c_irq, 0,  in jz4780_i2c_probe()
792 			       dev_name(&pdev->dev), i2c);  in jz4780_i2c_probe()
798 	ret = i2c_add_adapter(&i2c->adap);  in jz4780_i2c_probe()
807 	clk_disable_unprepare(i2c->clk);  in jz4780_i2c_probe()
813 	struct jz4780_i2c *i2c = platform_get_drvdata(pdev);  in jz4780_i2c_remove()  local
815 	clk_disable_unprepare(i2c->clk);  in jz4780_i2c_remove()
816 	i2c_del_adapter(&i2c->adap);  in jz4780_i2c_remove()