378 static u32 csid_src_pad_code(struct csid_device *csid, u32 sink_code,  in csid_src_pad_code()  argument
381 	if (csid->camss->version == CAMSS_8x16) {  in csid_src_pad_code()
386 	} else if (csid->camss->version == CAMSS_8x96) {  in csid_src_pad_code()
444 	struct csid_device *csid = dev;  in csid_isr()  local
445 	enum camss_version ver = csid->camss->version;  in csid_isr()
448 	value = readl_relaxed(csid->base + CAMSS_CSID_IRQ_STATUS(ver));  in csid_isr()
449 	writel_relaxed(value, csid->base + CAMSS_CSID_IRQ_CLEAR_CMD(ver));  in csid_isr()
452 		complete(&csid->reset_complete);  in csid_isr()
461 static int csid_set_clock_rates(struct csid_device *csid)  in csid_set_clock_rates()  argument
463 	struct device *dev = csid->camss->dev;  in csid_set_clock_rates()
468 	ret = camss_get_pixel_clock(&csid->subdev.entity, &pixel_clock);  in csid_set_clock_rates()
472 	for (i = 0; i < csid->nclocks; i++) {  in csid_set_clock_rates()
473 		struct camss_clock *clock = &csid->clock[i];  in csid_set_clock_rates()
480 				csid->formats,  in csid_set_clock_rates()
481 				csid->nformats,  in csid_set_clock_rates()
482 				csid->fmt[MSM_CSIPHY_PAD_SINK].code);  in csid_set_clock_rates()
483 			u8 num_lanes = csid->phy.lane_cnt;  in csid_set_clock_rates()
529 static int csid_reset(struct csid_device *csid)  in csid_reset()  argument
533 	reinit_completion(&csid->reset_complete);  in csid_reset()
535 	writel_relaxed(0x7fff, csid->base +  in csid_reset()
536 		       CAMSS_CSID_RST_CMD(csid->camss->version));  in csid_reset()
538 	time = wait_for_completion_timeout(&csid->reset_complete,  in csid_reset()
541 		dev_err(csid->camss->dev, "CSID reset timeout\n");  in csid_reset()
557 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_set_power()  local
558 	struct device *dev = csid->camss->dev;  in csid_set_power()
570 		ret = regulator_enable(csid->vdda);  in csid_set_power()
576 		ret = csid_set_clock_rates(csid);  in csid_set_power()
578 			regulator_disable(csid->vdda);  in csid_set_power()
583 		ret = camss_enable_clocks(csid->nclocks, csid->clock, dev);  in csid_set_power()
585 			regulator_disable(csid->vdda);  in csid_set_power()
590 		enable_irq(csid->irq);  in csid_set_power()
592 		ret = csid_reset(csid);  in csid_set_power()
594 			disable_irq(csid->irq);  in csid_set_power()
595 			camss_disable_clocks(csid->nclocks, csid->clock);  in csid_set_power()
596 			regulator_disable(csid->vdda);  in csid_set_power()
601 		hw_version = readl_relaxed(csid->base + CAMSS_CSID_HW_VERSION);  in csid_set_power()
604 		disable_irq(csid->irq);  in csid_set_power()
605 		camss_disable_clocks(csid->nclocks, csid->clock);  in csid_set_power()
606 		ret = regulator_disable(csid->vdda);  in csid_set_power()
624 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_set_stream()  local
625 	struct csid_testgen_config *tg = &csid->testgen;  in csid_set_stream()
626 	enum camss_version ver = csid->camss->version;  in csid_set_stream()
635 		ret = v4l2_ctrl_handler_setup(&csid->ctrls);  in csid_set_stream()
637 			dev_err(csid->camss->dev,  in csid_set_stream()
643 		    !media_entity_remote_pad(&csid->pads[MSM_CSID_PAD_SINK]))  in csid_set_stream()
649 					&csid->fmt[MSM_CSID_PAD_SRC];  in csid_set_stream()
651 					csid->formats, csid->nformats, f->code);  in csid_set_stream()
660 			writel_relaxed(val, csid->base +  in csid_set_stream()
666 			writel_relaxed(val, csid->base +  in csid_set_stream()
673 			writel_relaxed(val, csid->base +  in csid_set_stream()
678 			writel_relaxed(val, csid->base +  in csid_set_stream()
684 					&csid->fmt[MSM_CSID_PAD_SINK];  in csid_set_stream()
686 					csid->formats, csid->nformats, f->code);  in csid_set_stream()
687 			struct csid_phy_config *phy = &csid->phy;  in csid_set_stream()
693 				       csid->base + CAMSS_CSID_CORE_CTRL_0);  in csid_set_stream()
699 				       csid->base + CAMSS_CSID_CORE_CTRL_1);  in csid_set_stream()
709 		val = readl_relaxed(csid->base +  in csid_set_stream()
713 		writel_relaxed(val, csid->base +  in csid_set_stream()
721 		if (csid->camss->version == CAMSS_8x96) {  in csid_set_stream()
722 			u32 sink_code = csid->fmt[MSM_CSID_PAD_SINK].code;  in csid_set_stream()
723 			u32 src_code = csid->fmt[MSM_CSID_PAD_SRC].code;  in csid_set_stream()
735 		writel_relaxed(val, csid->base +  in csid_set_stream()
740 			writel_relaxed(val, csid->base +  in csid_set_stream()
746 			writel_relaxed(val, csid->base +  in csid_set_stream()
764 __csid_get_format(struct csid_device *csid,  in __csid_get_format()  argument
770 		return v4l2_subdev_get_try_format(&csid->subdev, cfg, pad);  in __csid_get_format()
772 	return &csid->fmt[pad];  in __csid_get_format()
783 static void csid_try_format(struct csid_device *csid,  in csid_try_format()  argument
795 		for (i = 0; i < csid->nformats; i++)  in csid_try_format()
796 			if (fmt->code == csid->formats[i].code)  in csid_try_format()
800 		if (i >= csid->nformats)  in csid_try_format()
812 		if (csid->testgen_mode->cur.val == 0) {  in csid_try_format()
817 			*fmt = *__csid_get_format(csid, cfg,  in csid_try_format()
819 			fmt->code = csid_src_pad_code(csid, fmt->code, 0, code);  in csid_try_format()
824 			for (i = 0; i < csid->nformats; i++)  in csid_try_format()
825 				if (csid->formats[i].code == fmt->code)  in csid_try_format()
829 			if (i >= csid->nformats)  in csid_try_format()
854 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_enum_mbus_code()  local
857 		if (code->index >= csid->nformats)  in csid_enum_mbus_code()
860 		code->code = csid->formats[code->index].code;  in csid_enum_mbus_code()
862 		if (csid->testgen_mode->cur.val == 0) {  in csid_enum_mbus_code()
865 			sink_fmt = __csid_get_format(csid, cfg,  in csid_enum_mbus_code()
869 			code->code = csid_src_pad_code(csid, sink_fmt->code,  in csid_enum_mbus_code()
874 			if (code->index >= csid->nformats)  in csid_enum_mbus_code()
877 			code->code = csid->formats[code->index].code;  in csid_enum_mbus_code()
895 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_enum_frame_size()  local
904 	csid_try_format(csid, cfg, fse->pad, &format, fse->which);  in csid_enum_frame_size()
914 	csid_try_format(csid, cfg, fse->pad, &format, fse->which);  in csid_enum_frame_size()
933 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_get_format()  local
936 	format = __csid_get_format(csid, cfg, fmt->pad, fmt->which);  in csid_get_format()
957 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_set_format()  local
960 	format = __csid_get_format(csid, cfg, fmt->pad, fmt->which);  in csid_set_format()
964 	csid_try_format(csid, cfg, fmt->pad, &fmt->format, fmt->which);  in csid_set_format()
969 		format = __csid_get_format(csid, cfg, MSM_CSID_PAD_SRC,  in csid_set_format()
973 		csid_try_format(csid, cfg, MSM_CSID_PAD_SRC, format,  in csid_set_format()
1021 static int csid_set_test_pattern(struct csid_device *csid, s32 value)  in csid_set_test_pattern()  argument
1023 	struct csid_testgen_config *tg = &csid->testgen;  in csid_set_test_pattern()
1026 	if (value && media_entity_remote_pad(&csid->pads[MSM_CSID_PAD_SINK]))  in csid_set_test_pattern()
1060 	struct csid_device *csid = container_of(ctrl->handler,  in csid_s_ctrl()  local
1066 		ret = csid_set_test_pattern(csid, ctrl->val);  in csid_s_ctrl()
1085 int msm_csid_subdev_init(struct camss *camss, struct csid_device *csid,  in msm_csid_subdev_init()  argument
1094 	csid->camss = camss;  in msm_csid_subdev_init()
1095 	csid->id = id;  in msm_csid_subdev_init()
1098 		csid->formats = csid_formats_8x16;  in msm_csid_subdev_init()
1099 		csid->nformats =  in msm_csid_subdev_init()
1102 		csid->formats = csid_formats_8x96;  in msm_csid_subdev_init()
1103 		csid->nformats =  in msm_csid_subdev_init()
1112 	csid->base = devm_ioremap_resource(dev, r);  in msm_csid_subdev_init()
1113 	if (IS_ERR(csid->base)) {  in msm_csid_subdev_init()
1115 		return PTR_ERR(csid->base);  in msm_csid_subdev_init()
1127 	csid->irq = r->start;  in msm_csid_subdev_init()
1128 	snprintf(csid->irq_name, sizeof(csid->irq_name), "%s_%s%d",  in msm_csid_subdev_init()
1129 		 dev_name(dev), MSM_CSID_NAME, csid->id);  in msm_csid_subdev_init()
1130 	ret = devm_request_irq(dev, csid->irq, csid_isr,  in msm_csid_subdev_init()
1131 		IRQF_TRIGGER_RISING, csid->irq_name, csid);  in msm_csid_subdev_init()
1137 	disable_irq(csid->irq);  in msm_csid_subdev_init()
1141 	csid->nclocks = 0;  in msm_csid_subdev_init()
1142 	while (res->clock[csid->nclocks])  in msm_csid_subdev_init()
1143 		csid->nclocks++;  in msm_csid_subdev_init()
1145 	csid->clock = devm_kcalloc(dev, csid->nclocks, sizeof(*csid->clock),  in msm_csid_subdev_init()
1147 	if (!csid->clock)  in msm_csid_subdev_init()
1150 	for (i = 0; i < csid->nclocks; i++) {  in msm_csid_subdev_init()
1151 		struct camss_clock *clock = &csid->clock[i];  in msm_csid_subdev_init()
1181 	csid->vdda = devm_regulator_get(dev, res->regulator[0]);  in msm_csid_subdev_init()
1182 	if (IS_ERR(csid->vdda)) {  in msm_csid_subdev_init()
1184 		return PTR_ERR(csid->vdda);  in msm_csid_subdev_init()
1187 	init_completion(&csid->reset_complete);  in msm_csid_subdev_init()
1200 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in msm_csid_get_csid_id()  local
1202 	*id = csid->id;  in msm_csid_get_csid_id()
1242 		struct csid_device *csid;  in csid_link_setup()  local
1248 		csid = v4l2_get_subdevdata(sd);  in csid_link_setup()
1252 		if (csid->testgen_mode->cur.val != 0)  in csid_link_setup()
1263 		csid->phy.csiphy_id = csiphy->id;  in csid_link_setup()
1266 		csid->phy.lane_cnt = lane_cfg->num_data;  in csid_link_setup()
1267 		csid->phy.lane_assign = csid_get_lane_assign(lane_cfg);  in csid_link_setup()
1272 		csid_set_format(&csid->subdev, NULL, &format);  in csid_link_setup()
1317 int msm_csid_register_entity(struct csid_device *csid,  in msm_csid_register_entity()  argument
1320 	struct v4l2_subdev *sd = &csid->subdev;  in msm_csid_register_entity()
1321 	struct media_pad *pads = csid->pads;  in msm_csid_register_entity()
1322 	struct device *dev = csid->camss->dev;  in msm_csid_register_entity()
1330 		 MSM_CSID_NAME, csid->id);  in msm_csid_register_entity()
1331 	v4l2_set_subdevdata(sd, csid);  in msm_csid_register_entity()
1333 	ret = v4l2_ctrl_handler_init(&csid->ctrls, 1);  in msm_csid_register_entity()
1339 	csid->testgen_mode = v4l2_ctrl_new_std_menu_items(&csid->ctrls,  in msm_csid_register_entity()
1344 	if (csid->ctrls.error) {  in msm_csid_register_entity()
1345 		dev_err(dev, "Failed to init ctrl: %d\n", csid->ctrls.error);  in msm_csid_register_entity()
1346 		ret = csid->ctrls.error;  in msm_csid_register_entity()
1350 	csid->subdev.ctrl_handler = &csid->ctrls;  in msm_csid_register_entity()
1380 	v4l2_ctrl_handler_free(&csid->ctrls);  in msm_csid_register_entity()
1389 void msm_csid_unregister_entity(struct csid_device *csid)  in msm_csid_unregister_entity()  argument
1391 	v4l2_device_unregister_subdev(&csid->subdev);  in msm_csid_unregister_entity()
1392 	media_entity_cleanup(&csid->subdev.entity);  in msm_csid_unregister_entity()
1393 	v4l2_ctrl_handler_free(&csid->ctrls);  in msm_csid_unregister_entity()