media/tegra-video/tegra210.c

17 #include "csi.h"
329 	 * events due to source not streaming or noisy csi inputs from the
639 	/* clear csi errors and do capture setup for all ports in gang mode */
830 static void csi_write(struct tegra_csi *csi, u8 portno, unsigned int addr,
835 	csi_pp_base = csi->iomem + CSI_PP_OFFSET(portno >> 1);
841 static void pp_write(struct tegra_csi *csi, u8 portno, u32 addr, u32 val)
846 	csi_pp_base = csi->iomem + CSI_PP_OFFSET(portno >> 1);
852 static u32 pp_read(struct tegra_csi *csi, u8 portno, u32 addr)
857 	csi_pp_base = csi->iomem + CSI_PP_OFFSET(portno >> 1);
864 static void cil_write(struct tegra_csi *csi, u8 portno, u32 addr, u32 val)
869 	csi_cil_base = csi->iomem + CSI_PP_OFFSET(portno >> 1) +
876 static u32 cil_read(struct tegra_csi *csi, u8 portno, u32 addr)
881 	csi_cil_base = csi->iomem + CSI_PP_OFFSET(portno >> 1) +
889 static void tpg_write(struct tegra_csi *csi, u8 portno, unsigned int addr,
895 	csi_pp_base = csi->iomem + CSI_PP_OFFSET(portno >> 1);
908 	struct tegra_csi *csi = csi_chan->csi;
916 	val = pp_read(csi, portno, TEGRA_CSI_PIXEL_PARSER_STATUS);
917 	dev_dbg(csi->dev, "TEGRA_CSI_PIXEL_PARSER_STATUS 0x%08x\n", val);
919 	val = cil_read(csi, portno, TEGRA_CSI_CIL_STATUS);
920 	dev_dbg(csi->dev, "TEGRA_CSI_CIL_STATUS 0x%08x\n", val);
922 	val = cil_read(csi, portno, TEGRA_CSI_CILX_STATUS);
923 	dev_dbg(csi->dev, "TEGRA_CSI_CILX_STATUS 0x%08x\n", val);
927 		cil_write(csi, portno, TEGRA_CSI_CIL_SW_SENSOR_RESET, 0x1);
928 		cil_write(csi, portno + 1, TEGRA_CSI_CIL_SW_SENSOR_RESET, 0x1);
935 		csi_write(csi, portno, TEGRA_CSI_CSI_SW_STATUS_RESET, 0x1);
940 		cil_write(csi, portno + 1, TEGRA_CSI_CIL_SW_SENSOR_RESET, 0x0);
941 		cil_write(csi, portno, TEGRA_CSI_CIL_SW_SENSOR_RESET, 0x0);
942 		csi_write(csi, portno, TEGRA_CSI_CSI_SW_STATUS_RESET, 0x0);
945 		cil_write(csi, portno, TEGRA_CSI_CIL_SW_SENSOR_RESET, 0x1);
947 		cil_write(csi, portno, TEGRA_CSI_CIL_SW_SENSOR_RESET, 0x0);
950 		pp_write(csi, portno, TEGRA_CSI_PIXEL_PARSER_STATUS,
952 		cil_write(csi, portno, TEGRA_CSI_CIL_STATUS, 0xffffffff);
953 		cil_write(csi, portno, TEGRA_CSI_CILX_STATUS, 0xffffffff);
970 	struct tegra_csi *csi = csi_chan->csi;
979 	csi_write(csi, portno, TEGRA_CSI_CLKEN_OVERRIDE, 0);
982 	pp_write(csi, portno, TEGRA_CSI_PIXEL_PARSER_STATUS, 0xffffffff);
983 	cil_write(csi, portno, TEGRA_CSI_CIL_STATUS, 0xffffffff);
984 	cil_write(csi, portno, TEGRA_CSI_CILX_STATUS, 0xffffffff);
985 	cil_write(csi, portno, TEGRA_CSI_CIL_INTERRUPT_MASK, 0x0);
988 	cil_write(csi, portno, TEGRA_CSI_CIL_PAD_CONFIG0, 0x0);
989 	cil_write(csi, portno, TEGRA_CSI_CIL_PHY_CONTROL,
1002 		cil_write(csi, portno + 1, TEGRA_CSI_CIL_STATUS, 0xffffffff);
1003 		cil_write(csi, portno + 1, TEGRA_CSI_CILX_STATUS, 0xffffffff);
1004 		cil_write(csi, portno + 1, TEGRA_CSI_CIL_INTERRUPT_MASK, 0x0);
1006 		cil_write(csi, portno, TEGRA_CSI_CIL_PAD_CONFIG0,
1008 		cil_write(csi, portno + 1, TEGRA_CSI_CIL_PAD_CONFIG0, 0x0);
1009 		cil_write(csi, portno + 1, TEGRA_CSI_CIL_INTERRUPT_MASK, 0x0);
1010 		cil_write(csi, portno + 1, TEGRA_CSI_CIL_PHY_CONTROL,
1013 		csi_write(csi, portno, TEGRA_CSI_PHY_CIL_COMMAND,
1019 		csi_write(csi, portno, TEGRA_CSI_PHY_CIL_COMMAND, val);
1023 	pp_write(csi, portno, TEGRA_CSI_PIXEL_STREAM_PP_COMMAND,
1026 	pp_write(csi, portno, TEGRA_CSI_PIXEL_PARSER_INTERRUPT_MASK, 0x0);
1027 	pp_write(csi, portno, TEGRA_CSI_PIXEL_STREAM_CONTROL0,
1035 	pp_write(csi, portno, TEGRA_CSI_PIXEL_STREAM_CONTROL1,
1038 	pp_write(csi, portno, TEGRA_CSI_PIXEL_STREAM_GAP,
1040 	pp_write(csi, portno, TEGRA_CSI_PIXEL_STREAM_EXPECTED_FRAME, 0x0);
1041 	pp_write(csi, portno, TEGRA_CSI_INPUT_STREAM_CONTROL,
1047 		tpg_write(csi, portno, TEGRA_CSI_PATTERN_GENERATOR_CTRL,
1050 		tpg_write(csi, portno, TEGRA_CSI_PG_BLANK,
1053 		tpg_write(csi, portno, TEGRA_CSI_PG_PHASE, 0x0);
1054 		tpg_write(csi, portno, TEGRA_CSI_PG_RED_FREQ,
1057 		tpg_write(csi, portno, TEGRA_CSI_PG_RED_FREQ_RATE, 0x0);
1058 		tpg_write(csi, portno, TEGRA_CSI_PG_GREEN_FREQ,
1061 		tpg_write(csi, portno, TEGRA_CSI_PG_GREEN_FREQ_RATE, 0x0);
1062 		tpg_write(csi, portno, TEGRA_CSI_PG_BLUE_FREQ,
1065 		tpg_write(csi, portno, TEGRA_CSI_PG_BLUE_FREQ_RATE, 0x0);
1068 	pp_write(csi, portno, TEGRA_CSI_PIXEL_STREAM_PP_COMMAND,
1078 	struct tegra_csi *csi = csi_chan->csi;
1081 	val = pp_read(csi, portno, TEGRA_CSI_PIXEL_PARSER_STATUS);
1083 	dev_dbg(csi->dev, "TEGRA_CSI_PIXEL_PARSER_STATUS 0x%08x\n", val);
1084 	pp_write(csi, portno, TEGRA_CSI_PIXEL_PARSER_STATUS, val);
1086 	val = cil_read(csi, portno, TEGRA_CSI_CIL_STATUS);
1087 	dev_dbg(csi->dev, "TEGRA_CSI_CIL_STATUS 0x%08x\n", val);
1088 	cil_write(csi, portno, TEGRA_CSI_CIL_STATUS, val);
1090 	val = cil_read(csi, portno, TEGRA_CSI_CILX_STATUS);
1091 	dev_dbg(csi->dev, "TEGRA_CSI_CILX_STATUS 0x%08x\n", val);
1092 	cil_write(csi, portno, TEGRA_CSI_CILX_STATUS, val);
1094 	pp_write(csi, portno, TEGRA_CSI_PIXEL_STREAM_PP_COMMAND,
1099 		tpg_write(csi, portno, TEGRA_CSI_PATTERN_GENERATOR_CTRL,
1105 		csi_write(csi, portno, TEGRA_CSI_PHY_CIL_COMMAND,
1112 		csi_write(csi, portno, TEGRA_CSI_PHY_CIL_COMMAND, val);
1197 	"csi",