159 static void bcm_kona_i2c_send_cmd_to_ctrl(struct bcm_kona_i2c_dev *dev,  in bcm_kona_i2c_send_cmd_to_ctrl()  argument
162 	dev_dbg(dev->device, "%s, %d\n", __func__, cmd);  in bcm_kona_i2c_send_cmd_to_ctrl()
168 		       dev->base + CS_OFFSET);  in bcm_kona_i2c_send_cmd_to_ctrl()
175 		       dev->base + CS_OFFSET);  in bcm_kona_i2c_send_cmd_to_ctrl()
182 		       dev->base + CS_OFFSET);  in bcm_kona_i2c_send_cmd_to_ctrl()
188 		       dev->base + CS_OFFSET);  in bcm_kona_i2c_send_cmd_to_ctrl()
192 		dev_err(dev->device, "Unknown command %d\n", cmd);  in bcm_kona_i2c_send_cmd_to_ctrl()
196 static void bcm_kona_i2c_enable_clock(struct bcm_kona_i2c_dev *dev)  in bcm_kona_i2c_enable_clock()  argument
198 	writel(readl(dev->base + CLKEN_OFFSET) | CLKEN_CLKEN_MASK,  in bcm_kona_i2c_enable_clock()
199 	       dev->base + CLKEN_OFFSET);  in bcm_kona_i2c_enable_clock()
202 static void bcm_kona_i2c_disable_clock(struct bcm_kona_i2c_dev *dev)  in bcm_kona_i2c_disable_clock()  argument
204 	writel(readl(dev->base + CLKEN_OFFSET) & ~CLKEN_CLKEN_MASK,  in bcm_kona_i2c_disable_clock()
205 	       dev->base + CLKEN_OFFSET);  in bcm_kona_i2c_disable_clock()
210 	struct bcm_kona_i2c_dev *dev = devid;  in bcm_kona_i2c_isr()  local
211 	uint32_t status = readl(dev->base + ISR_OFFSET);  in bcm_kona_i2c_isr()
219 		       dev->base + TXFCR_OFFSET);  in bcm_kona_i2c_isr()
221 	writel(status & ~ISR_RESERVED_MASK, dev->base + ISR_OFFSET);  in bcm_kona_i2c_isr()
222 	complete(&dev->done);  in bcm_kona_i2c_isr()
228 static int bcm_kona_i2c_wait_if_busy(struct bcm_kona_i2c_dev *dev)  in bcm_kona_i2c_wait_if_busy()  argument
232 	while (readl(dev->base + ISR_OFFSET) & ISR_CMDBUSY_MASK)  in bcm_kona_i2c_wait_if_busy()
234 			dev_err(dev->device, "CMDBUSY timeout\n");  in bcm_kona_i2c_wait_if_busy()
242 static int bcm_kona_send_i2c_cmd(struct bcm_kona_i2c_dev *dev,  in bcm_kona_send_i2c_cmd()  argument
249 	rc = bcm_kona_i2c_wait_if_busy(dev);  in bcm_kona_send_i2c_cmd()
254 	writel(IER_I2C_INT_EN_MASK, dev->base + IER_OFFSET);  in bcm_kona_send_i2c_cmd()
257 	reinit_completion(&dev->done);  in bcm_kona_send_i2c_cmd()
260 	bcm_kona_i2c_send_cmd_to_ctrl(dev, cmd);  in bcm_kona_send_i2c_cmd()
263 	time_left = wait_for_completion_timeout(&dev->done, time_left);  in bcm_kona_send_i2c_cmd()
266 	writel(0, dev->base + IER_OFFSET);  in bcm_kona_send_i2c_cmd()
269 		dev_err(dev->device, "controller timed out\n");  in bcm_kona_send_i2c_cmd()
274 	bcm_kona_i2c_send_cmd_to_ctrl(dev, BCM_CMD_NOACTION);  in bcm_kona_send_i2c_cmd()
280 static int bcm_kona_i2c_read_fifo_single(struct bcm_kona_i2c_dev *dev,  in bcm_kona_i2c_read_fifo_single()  argument
287 	reinit_completion(&dev->done);  in bcm_kona_i2c_read_fifo_single()
290 	writel(IER_READ_COMPLETE_INT_MASK, dev->base + IER_OFFSET);  in bcm_kona_i2c_read_fifo_single()
295 		dev->base + RXFCR_OFFSET);  in bcm_kona_i2c_read_fifo_single()
298 	time_left = wait_for_completion_timeout(&dev->done, time_left);  in bcm_kona_i2c_read_fifo_single()
301 	writel(0, dev->base + IER_OFFSET);  in bcm_kona_i2c_read_fifo_single()
304 		dev_err(dev->device, "RX FIFO time out\n");  in bcm_kona_i2c_read_fifo_single()
310 		*buf = readl(dev->base + RXFIFORDOUT_OFFSET);  in bcm_kona_i2c_read_fifo_single()
316 static int bcm_kona_i2c_read_fifo(struct bcm_kona_i2c_dev *dev,  in bcm_kona_i2c_read_fifo()  argument
332 		rc = bcm_kona_i2c_read_fifo_single(dev, tmp_buf, bytes_to_read,  in bcm_kona_i2c_read_fifo()
345 static int bcm_kona_i2c_write_byte(struct bcm_kona_i2c_dev *dev, uint8_t data,  in bcm_kona_i2c_write_byte()  argument
353 	rc = bcm_kona_i2c_wait_if_busy(dev);  in bcm_kona_i2c_write_byte()
358 	writel(ISR_SES_DONE_MASK, dev->base + ISR_OFFSET);  in bcm_kona_i2c_write_byte()
361 	writel(IER_I2C_INT_EN_MASK, dev->base + IER_OFFSET);  in bcm_kona_i2c_write_byte()
364 	reinit_completion(&dev->done);  in bcm_kona_i2c_write_byte()
367 	writel(data, dev->base + DAT_OFFSET);  in bcm_kona_i2c_write_byte()
370 	time_left = wait_for_completion_timeout(&dev->done, time_left);  in bcm_kona_i2c_write_byte()
373 	writel(0, dev->base + IER_OFFSET);  in bcm_kona_i2c_write_byte()
376 		dev_dbg(dev->device, "controller timed out\n");  in bcm_kona_i2c_write_byte()
380 	nak_received = readl(dev->base + CS_OFFSET) & CS_ACK_MASK ? 1 : 0;  in bcm_kona_i2c_write_byte()
383 		dev_dbg(dev->device, "unexpected NAK/ACK\n");  in bcm_kona_i2c_write_byte()
391 static int bcm_kona_i2c_write_fifo_single(struct bcm_kona_i2c_dev *dev,  in bcm_kona_i2c_write_fifo_single()  argument
399 	reinit_completion(&dev->done);  in bcm_kona_i2c_write_fifo_single()
403 	       dev->base + IER_OFFSET);  in bcm_kona_i2c_write_fifo_single()
406 	disable_irq(dev->irq);  in bcm_kona_i2c_write_fifo_single()
410 		writel(buf[k], (dev->base + DAT_OFFSET));  in bcm_kona_i2c_write_fifo_single()
413 	enable_irq(dev->irq);  in bcm_kona_i2c_write_fifo_single()
417 		time_left = wait_for_completion_timeout(&dev->done, time_left);  in bcm_kona_i2c_write_fifo_single()
418 		fifo_status = readl(dev->base + FIFO_STATUS_OFFSET);  in bcm_kona_i2c_write_fifo_single()
422 	writel(0, dev->base + IER_OFFSET);  in bcm_kona_i2c_write_fifo_single()
425 	if (readl(dev->base + CS_OFFSET) & CS_ACK_MASK) {  in bcm_kona_i2c_write_fifo_single()
426 		dev_err(dev->device, "unexpected NAK\n");  in bcm_kona_i2c_write_fifo_single()
432 		dev_err(dev->device, "completion timed out\n");  in bcm_kona_i2c_write_fifo_single()
441 static int bcm_kona_i2c_write_fifo(struct bcm_kona_i2c_dev *dev,  in bcm_kona_i2c_write_fifo()  argument
454 		rc = bcm_kona_i2c_write_fifo_single(dev, tmp_buf,  in bcm_kona_i2c_write_fifo()
467 static int bcm_kona_i2c_do_addr(struct bcm_kona_i2c_dev *dev,  in bcm_kona_i2c_do_addr()  argument
475 		if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)  in bcm_kona_i2c_do_addr()
480 		if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)  in bcm_kona_i2c_do_addr()
485 			if (bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART) < 0)  in bcm_kona_i2c_do_addr()
490 			if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)  in bcm_kona_i2c_do_addr()
496 		if (bcm_kona_i2c_write_byte(dev, addr, 0) < 0)  in bcm_kona_i2c_do_addr()
503 static void bcm_kona_i2c_enable_autosense(struct bcm_kona_i2c_dev *dev)  in bcm_kona_i2c_enable_autosense()  argument
505 	writel(readl(dev->base + CLKEN_OFFSET) & ~CLKEN_AUTOSENSE_OFF_MASK,  in bcm_kona_i2c_enable_autosense()
506 	       dev->base + CLKEN_OFFSET);  in bcm_kona_i2c_enable_autosense()
509 static void bcm_kona_i2c_config_timing(struct bcm_kona_i2c_dev *dev)  in bcm_kona_i2c_config_timing()  argument
511 	writel(readl(dev->base + HSTIM_OFFSET) & ~HSTIM_HS_MODE_MASK,  in bcm_kona_i2c_config_timing()
512 	       dev->base + HSTIM_OFFSET);  in bcm_kona_i2c_config_timing()
514 	writel((dev->std_cfg->prescale << TIM_PRESCALE_SHIFT) |  in bcm_kona_i2c_config_timing()
515 	       (dev->std_cfg->time_p << TIM_P_SHIFT) |  in bcm_kona_i2c_config_timing()
516 	       (dev->std_cfg->no_div << TIM_NO_DIV_SHIFT) |  in bcm_kona_i2c_config_timing()
517 	       (dev->std_cfg->time_div	<< TIM_DIV_SHIFT),  in bcm_kona_i2c_config_timing()
518 	       dev->base + TIM_OFFSET);  in bcm_kona_i2c_config_timing()
520 	writel((dev->std_cfg->time_m << CLKEN_M_SHIFT) |  in bcm_kona_i2c_config_timing()
521 	       (dev->std_cfg->time_n << CLKEN_N_SHIFT) |  in bcm_kona_i2c_config_timing()
523 	       dev->base + CLKEN_OFFSET);  in bcm_kona_i2c_config_timing()
526 static void bcm_kona_i2c_config_timing_hs(struct bcm_kona_i2c_dev *dev)  in bcm_kona_i2c_config_timing_hs()  argument
528 	writel((dev->hs_cfg->prescale << TIM_PRESCALE_SHIFT) |  in bcm_kona_i2c_config_timing_hs()
529 	       (dev->hs_cfg->time_p << TIM_P_SHIFT) |  in bcm_kona_i2c_config_timing_hs()
530 	       (dev->hs_cfg->no_div << TIM_NO_DIV_SHIFT) |  in bcm_kona_i2c_config_timing_hs()
531 	       (dev->hs_cfg->time_div << TIM_DIV_SHIFT),  in bcm_kona_i2c_config_timing_hs()
532 	       dev->base + TIM_OFFSET);  in bcm_kona_i2c_config_timing_hs()
534 	writel((dev->hs_cfg->hs_hold << HSTIM_HS_HOLD_SHIFT) |  in bcm_kona_i2c_config_timing_hs()
535 	       (dev->hs_cfg->hs_high_phase << HSTIM_HS_HIGH_PHASE_SHIFT) |  in bcm_kona_i2c_config_timing_hs()
536 	       (dev->hs_cfg->hs_setup << HSTIM_HS_SETUP_SHIFT),  in bcm_kona_i2c_config_timing_hs()
537 	       dev->base + HSTIM_OFFSET);  in bcm_kona_i2c_config_timing_hs()
539 	writel(readl(dev->base + HSTIM_OFFSET) | HSTIM_HS_MODE_MASK,  in bcm_kona_i2c_config_timing_hs()
540 	       dev->base + HSTIM_OFFSET);  in bcm_kona_i2c_config_timing_hs()
543 static int bcm_kona_i2c_switch_to_hs(struct bcm_kona_i2c_dev *dev)  in bcm_kona_i2c_switch_to_hs()  argument
548 	rc = bcm_kona_i2c_write_byte(dev, MASTERCODE, 1);  in bcm_kona_i2c_switch_to_hs()
555 	rc = clk_set_rate(dev->external_clk, HS_EXT_CLK_FREQ);  in bcm_kona_i2c_switch_to_hs()
557 		dev_err(dev->device, "%s: clk_set_rate returned %d\n",  in bcm_kona_i2c_switch_to_hs()
563 	bcm_kona_i2c_config_timing_hs(dev);  in bcm_kona_i2c_switch_to_hs()
566 	rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART);  in bcm_kona_i2c_switch_to_hs()
568 		dev_err(dev->device, "High speed restart command failed\n");  in bcm_kona_i2c_switch_to_hs()
573 static int bcm_kona_i2c_switch_to_std(struct bcm_kona_i2c_dev *dev)  in bcm_kona_i2c_switch_to_std()  argument
578 	bcm_kona_i2c_config_timing(dev);  in bcm_kona_i2c_switch_to_std()
581 	rc = clk_set_rate(dev->external_clk, STD_EXT_CLK_FREQ);  in bcm_kona_i2c_switch_to_std()
583 		dev_err(dev->device, "%s: clk_set_rate returned %d\n",  in bcm_kona_i2c_switch_to_std()
594 	struct bcm_kona_i2c_dev *dev = i2c_get_adapdata(adapter);  in bcm_kona_i2c_xfer()  local
599 	rc = clk_prepare_enable(dev->external_clk);  in bcm_kona_i2c_xfer()
601 		dev_err(dev->device, "%s: peri clock enable failed. err %d\n",  in bcm_kona_i2c_xfer()
607 	writel(0, dev->base + PADCTL_OFFSET);  in bcm_kona_i2c_xfer()
610 	bcm_kona_i2c_enable_clock(dev);  in bcm_kona_i2c_xfer()
613 	rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_START);  in bcm_kona_i2c_xfer()
615 		dev_err(dev->device, "Start command failed rc = %d\n", rc);  in bcm_kona_i2c_xfer()
620 	if (dev->hs_cfg) {  in bcm_kona_i2c_xfer()
621 		rc = bcm_kona_i2c_switch_to_hs(dev);  in bcm_kona_i2c_xfer()
632 			rc = bcm_kona_send_i2c_cmd(dev, BCM_CMD_RESTART);  in bcm_kona_i2c_xfer()
634 				dev_err(dev->device,  in bcm_kona_i2c_xfer()
642 			rc = bcm_kona_i2c_do_addr(dev, pmsg);  in bcm_kona_i2c_xfer()
644 				dev_err(dev->device,  in bcm_kona_i2c_xfer()
653 			rc = bcm_kona_i2c_read_fifo(dev, pmsg);  in bcm_kona_i2c_xfer()
655 				dev_err(dev->device, "read failure\n");  in bcm_kona_i2c_xfer()
659 			rc = bcm_kona_i2c_write_fifo(dev, pmsg);  in bcm_kona_i2c_xfer()
661 				dev_err(dev->device, "write failure");  in bcm_kona_i2c_xfer()
671 	bcm_kona_send_i2c_cmd(dev, BCM_CMD_STOP);  in bcm_kona_i2c_xfer()
674 	if (dev->hs_cfg) {  in bcm_kona_i2c_xfer()
675 		int hs_rc = bcm_kona_i2c_switch_to_std(dev);  in bcm_kona_i2c_xfer()
683 	writel(PADCTL_PAD_OUT_EN_MASK, dev->base + PADCTL_OFFSET);  in bcm_kona_i2c_xfer()
686 	bcm_kona_i2c_disable_clock(dev);  in bcm_kona_i2c_xfer()
688 	clk_disable_unprepare(dev->external_clk);  in bcm_kona_i2c_xfer()
704 static int bcm_kona_i2c_assign_bus_speed(struct bcm_kona_i2c_dev *dev)  in bcm_kona_i2c_assign_bus_speed()  argument
707 	int ret = of_property_read_u32(dev->device->of_node, "clock-frequency",  in bcm_kona_i2c_assign_bus_speed()
710 		dev_err(dev->device, "missing clock-frequency property\n");  in bcm_kona_i2c_assign_bus_speed()
716 		dev->std_cfg = &std_cfg_table[BCM_SPD_100K];  in bcm_kona_i2c_assign_bus_speed()
719 		dev->std_cfg = &std_cfg_table[BCM_SPD_400K];  in bcm_kona_i2c_assign_bus_speed()
722 		dev->std_cfg = &std_cfg_table[BCM_SPD_1MHZ];  in bcm_kona_i2c_assign_bus_speed()
726 		dev->std_cfg = &std_cfg_table[BCM_SPD_100K];  in bcm_kona_i2c_assign_bus_speed()
727 		dev->hs_cfg = &hs_cfg_table[BCM_SPD_3P4MHZ];  in bcm_kona_i2c_assign_bus_speed()
741 	struct bcm_kona_i2c_dev *dev;  in bcm_kona_i2c_probe()  local
745 	dev = devm_kzalloc(&pdev->dev, sizeof(*dev), GFP_KERNEL);  in bcm_kona_i2c_probe()
746 	if (!dev)  in bcm_kona_i2c_probe()
749 	platform_set_drvdata(pdev, dev);  in bcm_kona_i2c_probe()
750 	dev->device = &pdev->dev;  in bcm_kona_i2c_probe()
751 	init_completion(&dev->done);  in bcm_kona_i2c_probe()
754 	dev->base = devm_platform_ioremap_resource(pdev, 0);  in bcm_kona_i2c_probe()
755 	if (IS_ERR(dev->base))  in bcm_kona_i2c_probe()
756 		return PTR_ERR(dev->base);  in bcm_kona_i2c_probe()
759 	dev->external_clk = devm_clk_get(dev->device, NULL);  in bcm_kona_i2c_probe()
760 	if (IS_ERR(dev->external_clk)) {  in bcm_kona_i2c_probe()
761 		dev_err(dev->device, "couldn't get clock\n");  in bcm_kona_i2c_probe()
765 	rc = clk_set_rate(dev->external_clk, STD_EXT_CLK_FREQ);  in bcm_kona_i2c_probe()
767 		dev_err(dev->device, "%s: clk_set_rate returned %d\n",  in bcm_kona_i2c_probe()
772 	rc = clk_prepare_enable(dev->external_clk);  in bcm_kona_i2c_probe()
774 		dev_err(dev->device, "couldn't enable clock\n");  in bcm_kona_i2c_probe()
779 	rc = bcm_kona_i2c_assign_bus_speed(dev);  in bcm_kona_i2c_probe()
784 	bcm_kona_i2c_enable_clock(dev);  in bcm_kona_i2c_probe()
787 	bcm_kona_i2c_config_timing(dev);  in bcm_kona_i2c_probe()
790 	writel(0, dev->base + TOUT_OFFSET);  in bcm_kona_i2c_probe()
793 	bcm_kona_i2c_enable_autosense(dev);  in bcm_kona_i2c_probe()
797 	       dev->base + TXFCR_OFFSET);  in bcm_kona_i2c_probe()
800 	writel(0, dev->base + IER_OFFSET);  in bcm_kona_i2c_probe()
809 	       dev->base + ISR_OFFSET);  in bcm_kona_i2c_probe()
812 	dev->irq = platform_get_irq(pdev, 0);  in bcm_kona_i2c_probe()
813 	if (dev->irq < 0) {  in bcm_kona_i2c_probe()
814 		rc = dev->irq;  in bcm_kona_i2c_probe()
819 	rc = devm_request_irq(&pdev->dev, dev->irq, bcm_kona_i2c_isr,  in bcm_kona_i2c_probe()
820 			      IRQF_SHARED, pdev->name, dev);  in bcm_kona_i2c_probe()
822 		dev_err(dev->device, "failed to request irq %i\n", dev->irq);  in bcm_kona_i2c_probe()
827 	bcm_kona_i2c_send_cmd_to_ctrl(dev, BCM_CMD_NOACTION);  in bcm_kona_i2c_probe()
830 	writel(PADCTL_PAD_OUT_EN_MASK, dev->base + PADCTL_OFFSET);  in bcm_kona_i2c_probe()
833 	bcm_kona_i2c_disable_clock(dev);  in bcm_kona_i2c_probe()
836 	clk_disable_unprepare(dev->external_clk);  in bcm_kona_i2c_probe()
839 	adap = &dev->adapter;  in bcm_kona_i2c_probe()
840 	i2c_set_adapdata(adap, dev);  in bcm_kona_i2c_probe()
844 	adap->dev.parent = &pdev->dev;  in bcm_kona_i2c_probe()
845 	adap->dev.of_node = pdev->dev.of_node;  in bcm_kona_i2c_probe()
851 	dev_info(dev->device, "device registered successfully\n");  in bcm_kona_i2c_probe()
856 	bcm_kona_i2c_disable_clock(dev);  in bcm_kona_i2c_probe()
857 	clk_disable_unprepare(dev->external_clk);  in bcm_kona_i2c_probe()
864 	struct bcm_kona_i2c_dev *dev = platform_get_drvdata(pdev);  in bcm_kona_i2c_remove()  local
866 	i2c_del_adapter(&dev->adapter);  in bcm_kona_i2c_remove()