media/omap4iss/iss_csi2.c

15 #include "iss.h"
28 	iss_reg_update(csi2->iss, csi2->regs1, CSI2_CTRL, CSI2_CTRL_IF_EN,
88 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTRL, reg);
258 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_PING_ADDR(ctx->ctxnum),
260 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_PONG_ADDR(ctx->ctxnum),
286 	reg = iss_reg_read(csi2->iss, csi2->regs1, CSI2_CTX_CTRL1(ctxnum));
304 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_CTRL1(ctxnum), reg);
330 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_CTRL1(ctx->ctxnum), reg);
342 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_CTRL2(ctx->ctxnum), reg);
345 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_CTRL3(ctx->ctxnum),
349 	iss_reg_update(csi2->iss, csi2->regs1, CSI2_CTX_DAT_OFST(ctx->ctxnum),
352 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_PING_ADDR(ctx->ctxnum),
354 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_PONG_ADDR(ctx->ctxnum),
367 	reg = iss_reg_read(csi2->iss, csi2->regs1, CSI2_TIMING);
388 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_TIMING, reg);
401 		iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_IRQSTATUS(i),
404 			iss_reg_set(csi2->iss, csi2->regs1,
407 			iss_reg_clr(csi2->iss, csi2->regs1,
447 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_COMPLEXIO_IRQSTATUS, reg);
449 		iss_reg_set(csi2->iss, csi2->regs1, CSI2_COMPLEXIO_IRQENABLE,
452 		iss_reg_write(csi2->iss, csi2->regs1, CSI2_COMPLEXIO_IRQENABLE,
471 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_IRQSTATUS, reg);
473 		iss_reg_set(csi2->iss, csi2->regs1, CSI2_IRQENABLE, reg);
475 		iss_reg_write(csi2->iss, csi2->regs1, CSI2_IRQENABLE, 0);
495 	iss_reg_set(csi2->iss, csi2->regs1, CSI2_SYSCONFIG,
499 		iss_reg_read(csi2->iss, csi2->regs1, CSI2_SYSSTATUS) &
502 		dev_err(csi2->iss->dev, "CSI2: Soft reset timeout!\n");
506 	iss_reg_set(csi2->iss, csi2->regs1, CSI2_COMPLEXIO_CFG,
510 		iss_reg_read(csi2->iss, csi2->phy->phy_regs, REGISTER1) &
513 		dev_err(csi2->iss->dev, "CSI2: CSI2_96M_FCLK reset timeout!\n");
517 	iss_reg_update(csi2->iss, csi2->regs1, CSI2_SYSCONFIG,
600 #define CSI2_PRINT_REGISTER(iss, regs, name)\
601 	dev_dbg(iss->dev, "###CSI2 " #name "=0x%08x\n", \
602 		iss_reg_read(iss, regs, CSI2_##name))
606 	struct iss_device *iss = csi2->iss;
611 	dev_dbg(iss->dev, "-------------CSI2 Register dump-------------\n");
613 	CSI2_PRINT_REGISTER(iss, csi2->regs1, SYSCONFIG);
614 	CSI2_PRINT_REGISTER(iss, csi2->regs1, SYSSTATUS);
615 	CSI2_PRINT_REGISTER(iss, csi2->regs1, IRQENABLE);
616 	CSI2_PRINT_REGISTER(iss, csi2->regs1, IRQSTATUS);
617 	CSI2_PRINT_REGISTER(iss, csi2->regs1, CTRL);
618 	CSI2_PRINT_REGISTER(iss, csi2->regs1, DBG_H);
619 	CSI2_PRINT_REGISTER(iss, csi2->regs1, COMPLEXIO_CFG);
620 	CSI2_PRINT_REGISTER(iss, csi2->regs1, COMPLEXIO_IRQSTATUS);
621 	CSI2_PRINT_REGISTER(iss, csi2->regs1, SHORT_PACKET);
622 	CSI2_PRINT_REGISTER(iss, csi2->regs1, COMPLEXIO_IRQENABLE);
623 	CSI2_PRINT_REGISTER(iss, csi2->regs1, DBG_P);
624 	CSI2_PRINT_REGISTER(iss, csi2->regs1, TIMING);
625 	CSI2_PRINT_REGISTER(iss, csi2->regs1, CTX_CTRL1(0));
626 	CSI2_PRINT_REGISTER(iss, csi2->regs1, CTX_CTRL2(0));
627 	CSI2_PRINT_REGISTER(iss, csi2->regs1, CTX_DAT_OFST(0));
628 	CSI2_PRINT_REGISTER(iss, csi2->regs1, CTX_PING_ADDR(0));
629 	CSI2_PRINT_REGISTER(iss, csi2->regs1, CTX_PONG_ADDR(0));
630 	CSI2_PRINT_REGISTER(iss, csi2->regs1, CTX_IRQENABLE(0));
631 	CSI2_PRINT_REGISTER(iss, csi2->regs1, CTX_IRQSTATUS(0));
632 	CSI2_PRINT_REGISTER(iss, csi2->regs1, CTX_CTRL3(0));
634 	dev_dbg(iss->dev, "--------------------------------------------\n");
670 	status = iss_reg_read(csi2->iss, csi2->regs1, CSI2_CTX_IRQSTATUS(n));
671 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_CTX_IRQSTATUS(n), status);
683 		frame = iss_reg_read(csi2->iss, csi2->regs1,
744 	struct iss_device *iss = csi2->iss;
749 	csi2_irqstatus = iss_reg_read(csi2->iss, csi2->regs1, CSI2_IRQSTATUS);
750 	iss_reg_write(csi2->iss, csi2->regs1, CSI2_IRQSTATUS, csi2_irqstatus);
754 		cpxio1_irqstatus = iss_reg_read(csi2->iss, csi2->regs1,
756 		iss_reg_write(csi2->iss, csi2->regs1, CSI2_COMPLEXIO_IRQSTATUS,
758 		dev_dbg(iss->dev, "CSI2: ComplexIO Error IRQ %x\n",
768 		dev_dbg(iss->dev,
783 		dev_dbg(iss->dev, "CSI2: ECC correction done\n");
1070 	struct iss_device *iss = csi2->iss;
1078 		omap4iss_subclk_enable(iss, csi2->subclk);
1083 		ret = omap4iss_csiphy_config(iss, sd);
1118 		omap4iss_subclk_disable(iss, csi2->subclk);
1269 	sd->grp_id = BIT(16);	/* group ID for iss subdevs */
1289 	csi2->video_out.iss = csi2->iss;
1306 int omap4iss_csi2_init(struct iss_device *iss)
1308 	struct iss_csi2_device *csi2a = &iss->csi2a;
1309 	struct iss_csi2_device *csi2b = &iss->csi2b;
1312 	csi2a->iss = iss;
1315 	csi2a->phy = &iss->csiphy1;
1324 	csi2b->iss = iss;
1327 	csi2b->phy = &iss->csiphy2;
1341  * @iss: Pointer to ISS device
1345 int omap4iss_csi2_create_links(struct iss_device *iss)
1347 	struct iss_csi2_device *csi2a = &iss->csi2a;
1348 	struct iss_csi2_device *csi2b = &iss->csi2b;
1369 void omap4iss_csi2_cleanup(struct iss_device *iss)
1371 	struct iss_csi2_device *csi2a = &iss->csi2a;
1372 	struct iss_csi2_device *csi2b = &iss->csi2b;