116 #define cdns_i2c_readreg(offset)       readl_relaxed(id->membase + offset)
117 #define cdns_i2c_writereg(val, offset) writel_relaxed(val, id->membase + offset)
168 static void cdns_i2c_clear_bus_hold(struct cdns_i2c *id)  in cdns_i2c_clear_bus_hold()  argument
189 	struct cdns_i2c *id = ptr;  in cdns_i2c_isr()  local
208 	if (id->recv_count > id->curr_recv_count)  in cdns_i2c_isr()
212 	if (id->p_recv_buf &&  in cdns_i2c_isr()
223 			if ((id->recv_count < CDNS_I2C_FIFO_DEPTH) &&  in cdns_i2c_isr()
224 			    !id->bus_hold_flag)  in cdns_i2c_isr()
225 				cdns_i2c_clear_bus_hold(id);  in cdns_i2c_isr()
227 			*(id->p_recv_buf)++ =  in cdns_i2c_isr()
229 			id->recv_count--;  in cdns_i2c_isr()
230 			id->curr_recv_count--;  in cdns_i2c_isr()
233 			    (id->curr_recv_count == CDNS_I2C_FIFO_DEPTH + 1))  in cdns_i2c_isr()
245 		    (id->curr_recv_count == CDNS_I2C_FIFO_DEPTH + 1)) {  in cdns_i2c_isr()
248 			       (id->curr_recv_count - CDNS_I2C_FIFO_DEPTH))  in cdns_i2c_isr()
255 			if (((int)(id->recv_count) - CDNS_I2C_FIFO_DEPTH) >  in cdns_i2c_isr()
259 				id->curr_recv_count = CDNS_I2C_TRANSFER_SIZE +  in cdns_i2c_isr()
262 				cdns_i2c_writereg(id->recv_count -  in cdns_i2c_isr()
265 				id->curr_recv_count = id->recv_count;  in cdns_i2c_isr()
270 		if ((isr_status & CDNS_I2C_IXR_COMP) && !id->recv_count) {  in cdns_i2c_isr()
271 			if (!id->bus_hold_flag)  in cdns_i2c_isr()
272 				cdns_i2c_clear_bus_hold(id);  in cdns_i2c_isr()
280 	if ((isr_status & CDNS_I2C_IXR_COMP) && !id->p_recv_buf) {  in cdns_i2c_isr()
285 		if (id->send_count) {  in cdns_i2c_isr()
288 			if (id->send_count > avail_bytes)  in cdns_i2c_isr()
291 				bytes_to_send = id->send_count;  in cdns_i2c_isr()
295 					(*(id->p_send_buf)++),  in cdns_i2c_isr()
297 				id->send_count--;  in cdns_i2c_isr()
307 		if (!id->send_count && !id->bus_hold_flag)  in cdns_i2c_isr()
308 			cdns_i2c_clear_bus_hold(id);  in cdns_i2c_isr()
314 	id->err_status = isr_status & CDNS_I2C_IXR_ERR_INTR_MASK;  in cdns_i2c_isr()
315 	if (id->err_status)  in cdns_i2c_isr()
319 		complete(&id->xfer_done);  in cdns_i2c_isr()
328 static void cdns_i2c_mrecv(struct cdns_i2c *id)  in cdns_i2c_mrecv()  argument
333 	id->p_recv_buf = id->p_msg->buf;  in cdns_i2c_mrecv()
334 	id->recv_count = id->p_msg->len;  in cdns_i2c_mrecv()
340 	if (id->p_msg->flags & I2C_M_RECV_LEN)  in cdns_i2c_mrecv()
341 		id->recv_count = I2C_SMBUS_BLOCK_MAX + 1;  in cdns_i2c_mrecv()
343 	id->curr_recv_count = id->recv_count;  in cdns_i2c_mrecv()
349 	if (id->recv_count > CDNS_I2C_FIFO_DEPTH)  in cdns_i2c_mrecv()
364 	if (id->recv_count > CDNS_I2C_TRANSFER_SIZE) {  in cdns_i2c_mrecv()
367 		id->curr_recv_count = CDNS_I2C_TRANSFER_SIZE;  in cdns_i2c_mrecv()
369 		cdns_i2c_writereg(id->recv_count, CDNS_I2C_XFER_SIZE_OFFSET);  in cdns_i2c_mrecv()
373 	if (!id->bus_hold_flag &&  in cdns_i2c_mrecv()
374 		((id->p_msg->flags & I2C_M_RECV_LEN) != I2C_M_RECV_LEN) &&  in cdns_i2c_mrecv()
375 		(id->recv_count <= CDNS_I2C_FIFO_DEPTH))  in cdns_i2c_mrecv()
376 			cdns_i2c_clear_bus_hold(id);  in cdns_i2c_mrecv()
378 	cdns_i2c_writereg(id->p_msg->addr & CDNS_I2C_ADDR_MASK,  in cdns_i2c_mrecv()
387 static void cdns_i2c_msend(struct cdns_i2c *id)  in cdns_i2c_msend()  argument
394 	id->p_recv_buf = NULL;  in cdns_i2c_msend()
395 	id->p_send_buf = id->p_msg->buf;  in cdns_i2c_msend()
396 	id->send_count = id->p_msg->len;  in cdns_i2c_msend()
407 	if (id->send_count > CDNS_I2C_FIFO_DEPTH)  in cdns_i2c_msend()
423 	if (id->send_count > avail_bytes)  in cdns_i2c_msend()
426 		bytes_to_send = id->send_count;  in cdns_i2c_msend()
429 		cdns_i2c_writereg((*(id->p_send_buf)++), CDNS_I2C_DATA_OFFSET);  in cdns_i2c_msend()
430 		id->send_count--;  in cdns_i2c_msend()
437 	if (!id->bus_hold_flag && !id->send_count)  in cdns_i2c_msend()
438 		cdns_i2c_clear_bus_hold(id);  in cdns_i2c_msend()
440 	cdns_i2c_writereg(id->p_msg->addr & CDNS_I2C_ADDR_MASK,  in cdns_i2c_msend()
455 	struct cdns_i2c *id = adap->algo_data;  in cdns_i2c_master_reset()  local
475 static int cdns_i2c_process_msg(struct cdns_i2c *id, struct i2c_msg *msg,  in cdns_i2c_process_msg()  argument
481 	id->p_msg = msg;  in cdns_i2c_process_msg()
482 	id->err_status = 0;  in cdns_i2c_process_msg()
483 	reinit_completion(&id->xfer_done);  in cdns_i2c_process_msg()
499 		cdns_i2c_mrecv(id);  in cdns_i2c_process_msg()
501 		cdns_i2c_msend(id);  in cdns_i2c_process_msg()
504 	time_left = wait_for_completion_timeout(&id->xfer_done, adap->timeout);  in cdns_i2c_process_msg()
507 		dev_err(id->adap.dev.parent,  in cdns_i2c_process_msg()
516 	if (id->err_status & CDNS_I2C_IXR_ARB_LOST)  in cdns_i2c_process_msg()
537 	struct cdns_i2c *id = adap->algo_data;  in cdns_i2c_master_xfer()  local
562 		id->bus_hold_flag = 1;  in cdns_i2c_master_xfer()
567 		id->bus_hold_flag = 0;  in cdns_i2c_master_xfer()
573 			id->bus_hold_flag = 0;  in cdns_i2c_master_xfer()
575 		ret = cdns_i2c_process_msg(id, msgs, adap);  in cdns_i2c_master_xfer()
580 		if (id->err_status) {  in cdns_i2c_master_xfer()
583 			if (id->err_status & CDNS_I2C_IXR_NACK)  in cdns_i2c_master_xfer()
687 static int cdns_i2c_setclk(unsigned long clk_in, struct cdns_i2c *id)  in cdns_i2c_setclk()  argument
692 	unsigned long fscl = id->i2c_clk;  in cdns_i2c_setclk()
727 	struct cdns_i2c *id = to_cdns_i2c(nb);  in cdns_i2c_clk_notifier_cb()  local
729 	if (id->suspended)  in cdns_i2c_clk_notifier_cb()
736 		unsigned long fscl = id->i2c_clk;  in cdns_i2c_clk_notifier_cb()
742 			dev_warn(id->adap.dev.parent,  in cdns_i2c_clk_notifier_cb()
749 			cdns_i2c_setclk(ndata->new_rate, id);  in cdns_i2c_clk_notifier_cb()
754 		id->input_clk = ndata->new_rate;  in cdns_i2c_clk_notifier_cb()
757 			cdns_i2c_setclk(ndata->new_rate, id);  in cdns_i2c_clk_notifier_cb()
762 			cdns_i2c_setclk(ndata->old_rate, id);  in cdns_i2c_clk_notifier_cb()
831 	struct cdns_i2c *id;  in cdns_i2c_probe()  local
834 	id = devm_kzalloc(&pdev->dev, sizeof(*id), GFP_KERNEL);  in cdns_i2c_probe()
835 	if (!id)  in cdns_i2c_probe()
838 	platform_set_drvdata(pdev, id);  in cdns_i2c_probe()
841 	id->membase = devm_ioremap_resource(&pdev->dev, r_mem);  in cdns_i2c_probe()
842 	if (IS_ERR(id->membase))  in cdns_i2c_probe()
843 		return PTR_ERR(id->membase);  in cdns_i2c_probe()
845 	id->irq = platform_get_irq(pdev, 0);  in cdns_i2c_probe()
847 	id->adap.dev.of_node = pdev->dev.of_node;  in cdns_i2c_probe()
848 	id->adap.algo = &cdns_i2c_algo;  in cdns_i2c_probe()
849 	id->adap.timeout = CDNS_I2C_TIMEOUT;  in cdns_i2c_probe()
850 	id->adap.retries = 3;		/* Default retry value. */  in cdns_i2c_probe()
851 	id->adap.algo_data = id;  in cdns_i2c_probe()
852 	id->adap.dev.parent = &pdev->dev;  in cdns_i2c_probe()
853 	init_completion(&id->xfer_done);  in cdns_i2c_probe()
854 	snprintf(id->adap.name, sizeof(id->adap.name),  in cdns_i2c_probe()
857 	id->clk = devm_clk_get(&pdev->dev, NULL);  in cdns_i2c_probe()
858 	if (IS_ERR(id->clk)) {  in cdns_i2c_probe()
860 		return PTR_ERR(id->clk);  in cdns_i2c_probe()
862 	ret = clk_prepare_enable(id->clk);  in cdns_i2c_probe()
867 	id->clk_rate_change_nb.notifier_call = cdns_i2c_clk_notifier_cb;  in cdns_i2c_probe()
868 	if (clk_notifier_register(id->clk, &id->clk_rate_change_nb))  in cdns_i2c_probe()
870 	id->input_clk = clk_get_rate(id->clk);  in cdns_i2c_probe()
873 			&id->i2c_clk);  in cdns_i2c_probe()
874 	if (ret || (id->i2c_clk > CDNS_I2C_SPEED_MAX))  in cdns_i2c_probe()
875 		id->i2c_clk = CDNS_I2C_SPEED_DEFAULT;  in cdns_i2c_probe()
880 	ret = cdns_i2c_setclk(id->input_clk, id);  in cdns_i2c_probe()
882 		dev_err(&pdev->dev, "invalid SCL clock: %u Hz\n", id->i2c_clk);  in cdns_i2c_probe()
887 	ret = devm_request_irq(&pdev->dev, id->irq, cdns_i2c_isr, 0,  in cdns_i2c_probe()
888 				 DRIVER_NAME, id);  in cdns_i2c_probe()
890 		dev_err(&pdev->dev, "cannot get irq %d\n", id->irq);  in cdns_i2c_probe()
894 	ret = i2c_add_adapter(&id->adap);  in cdns_i2c_probe()
910 		 id->i2c_clk / 1000, (unsigned long)r_mem->start, id->irq);  in cdns_i2c_probe()
915 	clk_disable_unprepare(id->clk);  in cdns_i2c_probe()
929 	struct cdns_i2c *id = platform_get_drvdata(pdev);  in cdns_i2c_remove()  local
931 	i2c_del_adapter(&id->adap);  in cdns_i2c_remove()
932 	clk_notifier_unregister(id->clk, &id->clk_rate_change_nb);  in cdns_i2c_remove()
933 	clk_disable_unprepare(id->clk);  in cdns_i2c_remove()