186 static inline u32 ipu_csi_read(struct ipu_csi *csi, unsigned offset)  in ipu_csi_read()  argument
188 	return readl(csi->base + offset);  in ipu_csi_read()
191 static inline void ipu_csi_write(struct ipu_csi *csi, u32 value,  in ipu_csi_write()  argument
194 	writel(value, csi->base + offset);  in ipu_csi_write()
201 static int ipu_csi_set_testgen_mclk(struct ipu_csi *csi, u32 pixel_clk,  in ipu_csi_set_testgen_mclk()  argument
210 		dev_err(csi->ipu->dev,  in ipu_csi_set_testgen_mclk()
215 	temp = ipu_csi_read(csi, CSI_SENS_CONF);  in ipu_csi_set_testgen_mclk()
217 	ipu_csi_write(csi, temp | (div_ratio << CSI_SENS_CONF_DIVRATIO_SHIFT),  in ipu_csi_set_testgen_mclk()
361 int ipu_csi_init_interface(struct ipu_csi *csi,  in ipu_csi_init_interface()  argument
384 	spin_lock_irqsave(&csi->lock, flags);  in ipu_csi_init_interface()
386 	ipu_csi_write(csi, data, CSI_SENS_CONF);  in ipu_csi_init_interface()
389 	ipu_csi_write(csi,  in ipu_csi_init_interface()
397 		ipu_csi_write(csi, 0x40030, CSI_CCIR_CODE_1);  in ipu_csi_init_interface()
398 		ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3);  in ipu_csi_init_interface()
410 			ipu_csi_write(csi, 0x40596 | CSI_CCIR_ERR_DET_EN,  in ipu_csi_init_interface()
412 			ipu_csi_write(csi, 0xD07DF, CSI_CCIR_CODE_2);  in ipu_csi_init_interface()
413 			ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3);  in ipu_csi_init_interface()
424 			ipu_csi_write(csi, 0xD07DF | CSI_CCIR_ERR_DET_EN,  in ipu_csi_init_interface()
426 			ipu_csi_write(csi, 0x40596, CSI_CCIR_CODE_2);  in ipu_csi_init_interface()
427 			ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3);  in ipu_csi_init_interface()
429 			dev_err(csi->ipu->dev,  in ipu_csi_init_interface()
431 			spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_init_interface()
439 		ipu_csi_write(csi, 0x40030 | CSI_CCIR_ERR_DET_EN,  in ipu_csi_init_interface()
441 		ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3);  in ipu_csi_init_interface()
445 		ipu_csi_write(csi, 0, CSI_CCIR_CODE_1);  in ipu_csi_init_interface()
449 	dev_dbg(csi->ipu->dev, "CSI_SENS_CONF = 0x%08X\n",  in ipu_csi_init_interface()
450 		ipu_csi_read(csi, CSI_SENS_CONF));  in ipu_csi_init_interface()
451 	dev_dbg(csi->ipu->dev, "CSI_ACT_FRM_SIZE = 0x%08X\n",  in ipu_csi_init_interface()
452 		ipu_csi_read(csi, CSI_ACT_FRM_SIZE));  in ipu_csi_init_interface()
454 	spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_init_interface()
460 bool ipu_csi_is_interlaced(struct ipu_csi *csi)  in ipu_csi_is_interlaced()  argument
465 	spin_lock_irqsave(&csi->lock, flags);  in ipu_csi_is_interlaced()
467 		(ipu_csi_read(csi, CSI_SENS_CONF) &  in ipu_csi_is_interlaced()
470 	spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_is_interlaced()
484 		dev_err(csi->ipu->dev,  in ipu_csi_is_interlaced()
485 			"CSI %d sensor protocol unsupported\n", csi->id);  in ipu_csi_is_interlaced()
491 void ipu_csi_get_window(struct ipu_csi *csi, struct v4l2_rect *w)  in ipu_csi_get_window()  argument
496 	spin_lock_irqsave(&csi->lock, flags);  in ipu_csi_get_window()
498 	reg = ipu_csi_read(csi, CSI_ACT_FRM_SIZE);  in ipu_csi_get_window()
502 	reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL);  in ipu_csi_get_window()
506 	spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_get_window()
510 void ipu_csi_set_window(struct ipu_csi *csi, struct v4l2_rect *w)  in ipu_csi_set_window()  argument
515 	spin_lock_irqsave(&csi->lock, flags);  in ipu_csi_set_window()
517 	ipu_csi_write(csi, (w->width - 1) | ((w->height - 1) << 16),  in ipu_csi_set_window()
520 	reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL);  in ipu_csi_set_window()
523 	ipu_csi_write(csi, reg, CSI_OUT_FRM_CTRL);  in ipu_csi_set_window()
525 	spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_set_window()
529 void ipu_csi_set_test_generator(struct ipu_csi *csi, bool active,  in ipu_csi_set_test_generator()  argument
534 	u32 ipu_clk = clk_get_rate(csi->clk_ipu);  in ipu_csi_set_test_generator()
537 	spin_lock_irqsave(&csi->lock, flags);  in ipu_csi_set_test_generator()
539 	temp = ipu_csi_read(csi, CSI_TST_CTRL);  in ipu_csi_set_test_generator()
543 		ipu_csi_write(csi, temp, CSI_TST_CTRL);  in ipu_csi_set_test_generator()
546 		ipu_csi_set_testgen_mclk(csi, pix_clk, ipu_clk);  in ipu_csi_set_test_generator()
554 		ipu_csi_write(csi, temp, CSI_TST_CTRL);  in ipu_csi_set_test_generator()
557 	spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_set_test_generator()
561 int ipu_csi_set_mipi_datatype(struct ipu_csi *csi, u32 vc,  in ipu_csi_set_mipi_datatype()  argument
573 	spin_lock_irqsave(&csi->lock, flags);  in ipu_csi_set_mipi_datatype()
575 	temp = ipu_csi_read(csi, CSI_MIPI_DI);  in ipu_csi_set_mipi_datatype()
578 	ipu_csi_write(csi, temp, CSI_MIPI_DI);  in ipu_csi_set_mipi_datatype()
580 	spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_set_mipi_datatype()
586 int ipu_csi_set_skip_smfc(struct ipu_csi *csi, u32 skip,  in ipu_csi_set_skip_smfc()  argument
595 	spin_lock_irqsave(&csi->lock, flags);  in ipu_csi_set_skip_smfc()
597 	temp = ipu_csi_read(csi, CSI_SKIP);  in ipu_csi_set_skip_smfc()
603 	ipu_csi_write(csi, temp, CSI_SKIP);  in ipu_csi_set_skip_smfc()
605 	spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_set_skip_smfc()
611 int ipu_csi_set_dest(struct ipu_csi *csi, enum ipu_csi_dest csi_dest)  in ipu_csi_set_dest()  argument
621 	spin_lock_irqsave(&csi->lock, flags);  in ipu_csi_set_dest()
623 	csi_sens_conf = ipu_csi_read(csi, CSI_SENS_CONF);  in ipu_csi_set_dest()
626 	ipu_csi_write(csi, csi_sens_conf, CSI_SENS_CONF);  in ipu_csi_set_dest()
628 	spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_set_dest()
634 int ipu_csi_enable(struct ipu_csi *csi)  in ipu_csi_enable()  argument
636 	ipu_module_enable(csi->ipu, csi->module);  in ipu_csi_enable()
642 int ipu_csi_disable(struct ipu_csi *csi)  in ipu_csi_disable()  argument
644 	ipu_module_disable(csi->ipu, csi->module);  in ipu_csi_disable()
653 	struct ipu_csi *csi, *ret;  in ipu_csi_get()  local
658 	csi = ipu->csi_priv[id];  in ipu_csi_get()
659 	ret = csi;  in ipu_csi_get()
661 	spin_lock_irqsave(&csi->lock, flags);  in ipu_csi_get()
663 	if (csi->inuse) {  in ipu_csi_get()
668 	csi->inuse = true;  in ipu_csi_get()
670 	spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_get()
675 void ipu_csi_put(struct ipu_csi *csi)  in ipu_csi_put()  argument
679 	spin_lock_irqsave(&csi->lock, flags);  in ipu_csi_put()
680 	csi->inuse = false;  in ipu_csi_put()
681 	spin_unlock_irqrestore(&csi->lock, flags);  in ipu_csi_put()
688 	struct ipu_csi *csi;  in ipu_csi_init()  local
693 	csi = devm_kzalloc(dev, sizeof(*csi), GFP_KERNEL);  in ipu_csi_init()
694 	if (!csi)  in ipu_csi_init()
697 	ipu->csi_priv[id] = csi;  in ipu_csi_init()
699 	spin_lock_init(&csi->lock);  in ipu_csi_init()
700 	csi->module = module;  in ipu_csi_init()
701 	csi->id = id;  in ipu_csi_init()
702 	csi->clk_ipu = clk_ipu;  in ipu_csi_init()
703 	csi->base = devm_ioremap(dev, base, PAGE_SIZE);  in ipu_csi_init()
704 	if (!csi->base)  in ipu_csi_init()
708 		id, base, csi->base);  in ipu_csi_init()
709 	csi->ipu = ipu;  in ipu_csi_init()
718 void ipu_csi_dump(struct ipu_csi *csi)  in ipu_csi_dump()  argument
720 	dev_dbg(csi->ipu->dev, "CSI_SENS_CONF:     %08x\n",  in ipu_csi_dump()
721 		ipu_csi_read(csi, CSI_SENS_CONF));  in ipu_csi_dump()
722 	dev_dbg(csi->ipu->dev, "CSI_SENS_FRM_SIZE: %08x\n",  in ipu_csi_dump()
723 		ipu_csi_read(csi, CSI_SENS_FRM_SIZE));  in ipu_csi_dump()
724 	dev_dbg(csi->ipu->dev, "CSI_ACT_FRM_SIZE:  %08x\n",  in ipu_csi_dump()
725 		ipu_csi_read(csi, CSI_ACT_FRM_SIZE));  in ipu_csi_dump()
726 	dev_dbg(csi->ipu->dev, "CSI_OUT_FRM_CTRL:  %08x\n",  in ipu_csi_dump()
727 		ipu_csi_read(csi, CSI_OUT_FRM_CTRL));  in ipu_csi_dump()
728 	dev_dbg(csi->ipu->dev, "CSI_TST_CTRL:      %08x\n",  in ipu_csi_dump()
729 		ipu_csi_read(csi, CSI_TST_CTRL));  in ipu_csi_dump()
730 	dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_1:   %08x\n",  in ipu_csi_dump()
731 		ipu_csi_read(csi, CSI_CCIR_CODE_1));  in ipu_csi_dump()
732 	dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_2:   %08x\n",  in ipu_csi_dump()
733 		ipu_csi_read(csi, CSI_CCIR_CODE_2));  in ipu_csi_dump()
734 	dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_3:   %08x\n",  in ipu_csi_dump()
735 		ipu_csi_read(csi, CSI_CCIR_CODE_3));  in ipu_csi_dump()
736 	dev_dbg(csi->ipu->dev, "CSI_MIPI_DI:       %08x\n",  in ipu_csi_dump()
737 		ipu_csi_read(csi, CSI_MIPI_DI));  in ipu_csi_dump()
738 	dev_dbg(csi->ipu->dev, "CSI_SKIP:          %08x\n",  in ipu_csi_dump()
739 		ipu_csi_read(csi, CSI_SKIP));  in ipu_csi_dump()