119 #define cdns_i2c_readreg(offset)       readl_relaxed(id->membase + offset)
120 #define cdns_i2c_writereg(val, offset) writel_relaxed(val, id->membase + offset)
177 static void cdns_i2c_clear_bus_hold(struct cdns_i2c *id)  in cdns_i2c_clear_bus_hold()  argument
184 static inline bool cdns_is_holdquirk(struct cdns_i2c *id, bool hold_wrkaround)  in cdns_is_holdquirk()  argument
187 		(id->curr_recv_count == CDNS_I2C_FIFO_DEPTH + 1));  in cdns_is_holdquirk()
205 	struct cdns_i2c *id = ptr;  in cdns_i2c_isr()  local
224 	if (id->recv_count > id->curr_recv_count)  in cdns_i2c_isr()
227 	hold_quirk = (id->quirks & CDNS_I2C_BROKEN_HOLD_BIT) && updatetx;  in cdns_i2c_isr()
230 	if (id->p_recv_buf &&  in cdns_i2c_isr()
241 			if ((id->recv_count < CDNS_I2C_FIFO_DEPTH) &&  in cdns_i2c_isr()
242 			    !id->bus_hold_flag)  in cdns_i2c_isr()
243 				cdns_i2c_clear_bus_hold(id);  in cdns_i2c_isr()
245 			*(id->p_recv_buf)++ =  in cdns_i2c_isr()
247 			id->recv_count--;  in cdns_i2c_isr()
248 			id->curr_recv_count--;  in cdns_i2c_isr()
250 			if (cdns_is_holdquirk(id, hold_quirk))  in cdns_i2c_isr()
261 		if (cdns_is_holdquirk(id, hold_quirk)) {  in cdns_i2c_isr()
264 			       (id->curr_recv_count - CDNS_I2C_FIFO_DEPTH))  in cdns_i2c_isr()
271 			if (((int)(id->recv_count) - CDNS_I2C_FIFO_DEPTH) >  in cdns_i2c_isr()
275 				id->curr_recv_count = CDNS_I2C_TRANSFER_SIZE +  in cdns_i2c_isr()
278 				cdns_i2c_writereg(id->recv_count -  in cdns_i2c_isr()
281 				id->curr_recv_count = id->recv_count;  in cdns_i2c_isr()
283 		} else if (id->recv_count && !hold_quirk &&  in cdns_i2c_isr()
284 						!id->curr_recv_count) {  in cdns_i2c_isr()
287 			cdns_i2c_writereg(id->p_msg->addr & CDNS_I2C_ADDR_MASK,  in cdns_i2c_isr()
290 			if (id->recv_count > CDNS_I2C_TRANSFER_SIZE) {  in cdns_i2c_isr()
293 				id->curr_recv_count = CDNS_I2C_TRANSFER_SIZE;  in cdns_i2c_isr()
295 				cdns_i2c_writereg(id->recv_count,  in cdns_i2c_isr()
297 				id->curr_recv_count = id->recv_count;  in cdns_i2c_isr()
302 		if ((isr_status & CDNS_I2C_IXR_COMP) && !id->recv_count) {  in cdns_i2c_isr()
303 			if (!id->bus_hold_flag)  in cdns_i2c_isr()
304 				cdns_i2c_clear_bus_hold(id);  in cdns_i2c_isr()
312 	if ((isr_status & CDNS_I2C_IXR_COMP) && !id->p_recv_buf) {  in cdns_i2c_isr()
317 		if (id->send_count) {  in cdns_i2c_isr()
320 			if (id->send_count > avail_bytes)  in cdns_i2c_isr()
323 				bytes_to_send = id->send_count;  in cdns_i2c_isr()
327 					(*(id->p_send_buf)++),  in cdns_i2c_isr()
329 				id->send_count--;  in cdns_i2c_isr()
339 		if (!id->send_count && !id->bus_hold_flag)  in cdns_i2c_isr()
340 			cdns_i2c_clear_bus_hold(id);  in cdns_i2c_isr()
346 	id->err_status = isr_status & CDNS_I2C_IXR_ERR_INTR_MASK;  in cdns_i2c_isr()
347 	if (id->err_status)  in cdns_i2c_isr()
351 		complete(&id->xfer_done);  in cdns_i2c_isr()
360 static void cdns_i2c_mrecv(struct cdns_i2c *id)  in cdns_i2c_mrecv()  argument
365 	id->p_recv_buf = id->p_msg->buf;  in cdns_i2c_mrecv()
366 	id->recv_count = id->p_msg->len;  in cdns_i2c_mrecv()
372 	if (id->p_msg->flags & I2C_M_RECV_LEN)  in cdns_i2c_mrecv()
373 		id->recv_count = I2C_SMBUS_BLOCK_MAX + 1;  in cdns_i2c_mrecv()
375 	id->curr_recv_count = id->recv_count;  in cdns_i2c_mrecv()
381 	if (id->recv_count > CDNS_I2C_FIFO_DEPTH)  in cdns_i2c_mrecv()
396 	if (id->recv_count > CDNS_I2C_TRANSFER_SIZE) {  in cdns_i2c_mrecv()
399 		id->curr_recv_count = CDNS_I2C_TRANSFER_SIZE;  in cdns_i2c_mrecv()
401 		cdns_i2c_writereg(id->recv_count, CDNS_I2C_XFER_SIZE_OFFSET);  in cdns_i2c_mrecv()
405 	if (!id->bus_hold_flag &&  in cdns_i2c_mrecv()
406 		((id->p_msg->flags & I2C_M_RECV_LEN) != I2C_M_RECV_LEN) &&  in cdns_i2c_mrecv()
407 		(id->recv_count <= CDNS_I2C_FIFO_DEPTH))  in cdns_i2c_mrecv()
408 			cdns_i2c_clear_bus_hold(id);  in cdns_i2c_mrecv()
410 	cdns_i2c_writereg(id->p_msg->addr & CDNS_I2C_ADDR_MASK,  in cdns_i2c_mrecv()
419 static void cdns_i2c_msend(struct cdns_i2c *id)  in cdns_i2c_msend()  argument
426 	id->p_recv_buf = NULL;  in cdns_i2c_msend()
427 	id->p_send_buf = id->p_msg->buf;  in cdns_i2c_msend()
428 	id->send_count = id->p_msg->len;  in cdns_i2c_msend()
439 	if (id->send_count > CDNS_I2C_FIFO_DEPTH)  in cdns_i2c_msend()
455 	if (id->send_count > avail_bytes)  in cdns_i2c_msend()
458 		bytes_to_send = id->send_count;  in cdns_i2c_msend()
461 		cdns_i2c_writereg((*(id->p_send_buf)++), CDNS_I2C_DATA_OFFSET);  in cdns_i2c_msend()
462 		id->send_count--;  in cdns_i2c_msend()
469 	if (!id->bus_hold_flag && !id->send_count)  in cdns_i2c_msend()
470 		cdns_i2c_clear_bus_hold(id);  in cdns_i2c_msend()
472 	cdns_i2c_writereg(id->p_msg->addr & CDNS_I2C_ADDR_MASK,  in cdns_i2c_msend()
487 	struct cdns_i2c *id = adap->algo_data;  in cdns_i2c_master_reset()  local
507 static int cdns_i2c_process_msg(struct cdns_i2c *id, struct i2c_msg *msg,  in cdns_i2c_process_msg()  argument
513 	id->p_msg = msg;  in cdns_i2c_process_msg()
514 	id->err_status = 0;  in cdns_i2c_process_msg()
515 	reinit_completion(&id->xfer_done);  in cdns_i2c_process_msg()
531 		cdns_i2c_mrecv(id);  in cdns_i2c_process_msg()
533 		cdns_i2c_msend(id);  in cdns_i2c_process_msg()
536 	time_left = wait_for_completion_timeout(&id->xfer_done, adap->timeout);  in cdns_i2c_process_msg()
539 		dev_err(id->adap.dev.parent,  in cdns_i2c_process_msg()
548 	if (id->err_status & CDNS_I2C_IXR_ARB_LOST)  in cdns_i2c_process_msg()
569 	struct cdns_i2c *id = adap->algo_data;  in cdns_i2c_master_xfer()  local
576 	hold_quirk = !!(id->quirks & CDNS_I2C_BROKEN_HOLD_BIT);  in cdns_i2c_master_xfer()
596 		id->bus_hold_flag = 1;  in cdns_i2c_master_xfer()
601 		id->bus_hold_flag = 0;  in cdns_i2c_master_xfer()
607 			id->bus_hold_flag = 0;  in cdns_i2c_master_xfer()
609 		ret = cdns_i2c_process_msg(id, msgs, adap);  in cdns_i2c_master_xfer()
614 		if (id->err_status) {  in cdns_i2c_master_xfer()
617 			if (id->err_status & CDNS_I2C_IXR_NACK)  in cdns_i2c_master_xfer()
721 static int cdns_i2c_setclk(unsigned long clk_in, struct cdns_i2c *id)  in cdns_i2c_setclk()  argument
726 	unsigned long fscl = id->i2c_clk;  in cdns_i2c_setclk()
761 	struct cdns_i2c *id = to_cdns_i2c(nb);  in cdns_i2c_clk_notifier_cb()  local
763 	if (id->suspended)  in cdns_i2c_clk_notifier_cb()
770 		unsigned long fscl = id->i2c_clk;  in cdns_i2c_clk_notifier_cb()
776 			dev_warn(id->adap.dev.parent,  in cdns_i2c_clk_notifier_cb()
783 			cdns_i2c_setclk(ndata->new_rate, id);  in cdns_i2c_clk_notifier_cb()
788 		id->input_clk = ndata->new_rate;  in cdns_i2c_clk_notifier_cb()
791 			cdns_i2c_setclk(ndata->new_rate, id);  in cdns_i2c_clk_notifier_cb()
796 			cdns_i2c_setclk(ndata->old_rate, id);  in cdns_i2c_clk_notifier_cb()
876 	struct cdns_i2c *id;  in cdns_i2c_probe()  local
880 	id = devm_kzalloc(&pdev->dev, sizeof(*id), GFP_KERNEL);  in cdns_i2c_probe()
881 	if (!id)  in cdns_i2c_probe()
884 	platform_set_drvdata(pdev, id);  in cdns_i2c_probe()
889 		id->quirks = data->quirks;  in cdns_i2c_probe()
893 	id->membase = devm_ioremap_resource(&pdev->dev, r_mem);  in cdns_i2c_probe()
894 	if (IS_ERR(id->membase))  in cdns_i2c_probe()
895 		return PTR_ERR(id->membase);  in cdns_i2c_probe()
897 	id->irq = platform_get_irq(pdev, 0);  in cdns_i2c_probe()
899 	id->adap.owner = THIS_MODULE;  in cdns_i2c_probe()
900 	id->adap.dev.of_node = pdev->dev.of_node;  in cdns_i2c_probe()
901 	id->adap.algo = &cdns_i2c_algo;  in cdns_i2c_probe()
902 	id->adap.timeout = CDNS_I2C_TIMEOUT;  in cdns_i2c_probe()
903 	id->adap.retries = 3;		/* Default retry value. */  in cdns_i2c_probe()
904 	id->adap.algo_data = id;  in cdns_i2c_probe()
905 	id->adap.dev.parent = &pdev->dev;  in cdns_i2c_probe()
906 	init_completion(&id->xfer_done);  in cdns_i2c_probe()
907 	snprintf(id->adap.name, sizeof(id->adap.name),  in cdns_i2c_probe()
910 	id->clk = devm_clk_get(&pdev->dev, NULL);  in cdns_i2c_probe()
911 	if (IS_ERR(id->clk)) {  in cdns_i2c_probe()
913 		return PTR_ERR(id->clk);  in cdns_i2c_probe()
915 	ret = clk_prepare_enable(id->clk);  in cdns_i2c_probe()
920 	id->clk_rate_change_nb.notifier_call = cdns_i2c_clk_notifier_cb;  in cdns_i2c_probe()
921 	if (clk_notifier_register(id->clk, &id->clk_rate_change_nb))  in cdns_i2c_probe()
923 	id->input_clk = clk_get_rate(id->clk);  in cdns_i2c_probe()
926 			&id->i2c_clk);  in cdns_i2c_probe()
927 	if (ret || (id->i2c_clk > CDNS_I2C_SPEED_MAX))  in cdns_i2c_probe()
928 		id->i2c_clk = CDNS_I2C_SPEED_DEFAULT;  in cdns_i2c_probe()
933 	ret = cdns_i2c_setclk(id->input_clk, id);  in cdns_i2c_probe()
935 		dev_err(&pdev->dev, "invalid SCL clock: %u Hz\n", id->i2c_clk);  in cdns_i2c_probe()
940 	ret = devm_request_irq(&pdev->dev, id->irq, cdns_i2c_isr, 0,  in cdns_i2c_probe()
941 				 DRIVER_NAME, id);  in cdns_i2c_probe()
943 		dev_err(&pdev->dev, "cannot get irq %d\n", id->irq);  in cdns_i2c_probe()
947 	ret = i2c_add_adapter(&id->adap);  in cdns_i2c_probe()
963 		 id->i2c_clk / 1000, (unsigned long)r_mem->start, id->irq);  in cdns_i2c_probe()
968 	clk_disable_unprepare(id->clk);  in cdns_i2c_probe()
982 	struct cdns_i2c *id = platform_get_drvdata(pdev);  in cdns_i2c_remove()  local
984 	i2c_del_adapter(&id->adap);  in cdns_i2c_remove()
985 	clk_notifier_unregister(id->clk, &id->clk_rate_change_nb);  in cdns_i2c_remove()
986 	clk_disable_unprepare(id->clk);  in cdns_i2c_remove()