3  * camss-csid.c
5  * Qualcomm MSM Camera Subsystem - CSID (CSI Decoder) Module
24 #include "camss-csid.h"
25 #include "camss-csid-gen1.h"
28 /* offset of CSID registers in VFE region for VFE 480 */
528  * csid_set_clock_rates - Calculate and set clock rates on CSID module
529  * @csiphy: CSID device
531 static int csid_set_clock_rates(struct csid_device *csid)  in csid_set_clock_rates()  argument
533 	struct device *dev = csid->camss->dev;  in csid_set_clock_rates()
539 	fmt = csid_get_fmt_entry(csid->res->formats->formats, csid->res->formats->nformats,  in csid_set_clock_rates()
540 				 csid->fmt[MSM_CSIPHY_PAD_SINK].code);  in csid_set_clock_rates()
541 	link_freq = camss_get_link_freq(&csid->subdev.entity, fmt->bpp,  in csid_set_clock_rates()
542 					csid->phy.lane_cnt);  in csid_set_clock_rates()
546 	for (i = 0; i < csid->nclocks; i++) {  in csid_set_clock_rates()
547 		struct camss_clock *clock = &csid->clock[i];  in csid_set_clock_rates()
564 					"Pixel clock is too high for CSID\n");  in csid_set_clock_rates()
569 			/* set highest possible CSID clock rate */  in csid_set_clock_rates()
594  * csid_set_power - Power on/off CSID module
595  * @sd: CSID V4L2 subdevice
602 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_set_power()  local
603 	struct camss *camss = csid->camss;  in csid_set_power()
610 		 * switching on the CSID. Do so unconditionally, as there is no  in csid_set_power()
613 		ret = csid->res->parent_dev_ops->get(camss, csid->id);  in csid_set_power()
621 		ret = regulator_bulk_enable(csid->num_supplies,  in csid_set_power()
622 					    csid->supplies);  in csid_set_power()
628 		ret = csid_set_clock_rates(csid);  in csid_set_power()
630 			regulator_bulk_disable(csid->num_supplies,  in csid_set_power()
631 					       csid->supplies);  in csid_set_power()
636 		ret = camss_enable_clocks(csid->nclocks, csid->clock, dev);  in csid_set_power()
638 			regulator_bulk_disable(csid->num_supplies,  in csid_set_power()
639 					       csid->supplies);  in csid_set_power()
644 		csid->phy.need_vc_update = true;  in csid_set_power()
646 		enable_irq(csid->irq);  in csid_set_power()
648 		ret = csid->res->hw_ops->reset(csid);  in csid_set_power()
650 			disable_irq(csid->irq);  in csid_set_power()
651 			camss_disable_clocks(csid->nclocks, csid->clock);  in csid_set_power()
652 			regulator_bulk_disable(csid->num_supplies,  in csid_set_power()
653 					       csid->supplies);  in csid_set_power()
658 		csid->res->hw_ops->hw_version(csid);  in csid_set_power()
660 		disable_irq(csid->irq);  in csid_set_power()
661 		camss_disable_clocks(csid->nclocks, csid->clock);  in csid_set_power()
662 		regulator_bulk_disable(csid->num_supplies,  in csid_set_power()
663 				       csid->supplies);  in csid_set_power()
665 		csid->res->parent_dev_ops->put(camss, csid->id);  in csid_set_power()
672  * csid_set_stream - Enable/disable streaming on CSID module
673  * @sd: CSID V4L2 subdevice
676  * Main configuration of CSID module is also done here.
682 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_set_stream()  local
686 		ret = v4l2_ctrl_handler_setup(&csid->ctrls);  in csid_set_stream()
688 			dev_err(csid->camss->dev,  in csid_set_stream()
693 		if (!csid->testgen.enabled &&  in csid_set_stream()
694 		    !media_pad_remote_pad_first(&csid->pads[MSM_CSID_PAD_SINK]))  in csid_set_stream()
698 	if (csid->phy.need_vc_update) {  in csid_set_stream()
699 		csid->res->hw_ops->configure_stream(csid, enable);  in csid_set_stream()
700 		csid->phy.need_vc_update = false;  in csid_set_stream()
708  * @csid: CSID device
716 __csid_get_format(struct csid_device *csid,  in __csid_get_format()  argument
724 	return &csid->fmt[pad];  in __csid_get_format()
729  * @csid: CSID device
735 static void csid_try_format(struct csid_device *csid,  in csid_try_format()  argument
747 		for (i = 0; i < csid->res->formats->nformats; i++)  in csid_try_format()
748 			if (fmt->code == csid->res->formats->formats[i].code)  in csid_try_format()
752 		if (i >= csid->res->formats->nformats)  in csid_try_format()
764 		if (csid->testgen_mode->cur.val == 0) {  in csid_try_format()
769 			*fmt = *__csid_get_format(csid, sd_state,  in csid_try_format()
771 			fmt->code = csid->res->hw_ops->src_pad_code(csid, fmt->code, 0, code);  in csid_try_format()
776 			for (i = 0; i < csid->res->formats->nformats; i++)  in csid_try_format()
777 				if (csid->res->formats->formats[i].code == fmt->code)  in csid_try_format()
781 			if (i >= csid->res->formats->nformats)  in csid_try_format()
797  * @sd: CSID V4L2 subdevice
806 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_enum_mbus_code()  local
809 		if (code->index >= csid->res->formats->nformats)  in csid_enum_mbus_code()
812 		code->code = csid->res->formats->formats[code->index].code;  in csid_enum_mbus_code()
814 		if (csid->testgen_mode->cur.val == 0) {  in csid_enum_mbus_code()
817 			sink_fmt = __csid_get_format(csid, sd_state,  in csid_enum_mbus_code()
821 			code->code = csid->res->hw_ops->src_pad_code(csid, sink_fmt->code,  in csid_enum_mbus_code()
826 			if (code->index >= csid->res->formats->nformats)  in csid_enum_mbus_code()
829 			code->code = csid->res->formats->formats[code->index].code;  in csid_enum_mbus_code()
838  * @sd: CSID V4L2 subdevice
847 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_enum_frame_size()  local
856 	csid_try_format(csid, sd_state, fse->pad, &format, fse->which);  in csid_enum_frame_size()
866 	csid_try_format(csid, sd_state, fse->pad, &format, fse->which);  in csid_enum_frame_size()
875  * @sd: CSID V4L2 subdevice
885 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_get_format()  local
888 	format = __csid_get_format(csid, sd_state, fmt->pad, fmt->which);  in csid_get_format()
899  * @sd: CSID V4L2 subdevice
909 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_set_format()  local
913 	format = __csid_get_format(csid, sd_state, fmt->pad, fmt->which);  in csid_set_format()
917 	csid_try_format(csid, sd_state, fmt->pad, &fmt->format, fmt->which);  in csid_set_format()
923 			format = __csid_get_format(csid, sd_state, i, fmt->which);  in csid_set_format()
926 			csid_try_format(csid, sd_state, i, format, fmt->which);  in csid_set_format()
935  * @sd: CSID V4L2 subdevice
960  * @csid: CSID device
965 static int csid_set_test_pattern(struct csid_device *csid, s32 value)  in csid_set_test_pattern()  argument
967 	struct csid_testgen_config *tg = &csid->testgen;  in csid_set_test_pattern()
969 	/* If CSID is linked to CSIPHY, do not allow to enable test generator */  in csid_set_test_pattern()
970 	if (value && media_pad_remote_pad_first(&csid->pads[MSM_CSID_PAD_SINK]))  in csid_set_test_pattern()
975 	return csid->res->hw_ops->configure_testgen_pattern(csid, value);  in csid_set_test_pattern()
986 	struct csid_device *csid = container_of(ctrl->handler,  in csid_s_ctrl()  local
992 		ret = csid_set_test_pattern(csid, ctrl->val);  in csid_s_ctrl()
1004  * msm_csid_subdev_init - Initialize CSID device structure and resources
1005  * @csid: CSID device
1006  * @res: CSID module resources table
1007  * @id: CSID module id
1011 int msm_csid_subdev_init(struct camss *camss, struct csid_device *csid,  in msm_csid_subdev_init()  argument
1019 	csid->camss = camss;  in msm_csid_subdev_init()
1020 	csid->id = id;  in msm_csid_subdev_init()
1021 	csid->res = &res->csid;  in msm_csid_subdev_init()
1023 	if (dev_WARN_ONCE(dev, !csid->res->parent_dev_ops,  in msm_csid_subdev_init()
1024 			  "Error: CSID depends on VFE/IFE device ops!\n")) {  in msm_csid_subdev_init()
1028 	csid->res->hw_ops->subdev_init(csid);  in msm_csid_subdev_init()
1033 		/* for titan 480, CSID registers are inside the VFE region,  in msm_csid_subdev_init()
1035 		 * VFE to be initialized before CSID  in msm_csid_subdev_init()
1037 		if (id >= 2) /* VFE/CSID lite */  in msm_csid_subdev_init()
1038 			csid->base = csid->res->parent_dev_ops->get_base_address(camss, id)  in msm_csid_subdev_init()
1041 			csid->base = csid->res->parent_dev_ops->get_base_address(camss, id)  in msm_csid_subdev_init()
1044 		csid->base = devm_platform_ioremap_resource_byname(pdev, res->reg[0]);  in msm_csid_subdev_init()
1045 		if (IS_ERR(csid->base))  in msm_csid_subdev_init()
1046 			return PTR_ERR(csid->base);  in msm_csid_subdev_init()
1055 	csid->irq = ret;  in msm_csid_subdev_init()
1056 	snprintf(csid->irq_name, sizeof(csid->irq_name), "%s_%s%d",  in msm_csid_subdev_init()
1057 		 dev_name(dev), MSM_CSID_NAME, csid->id);  in msm_csid_subdev_init()
1058 	ret = devm_request_irq(dev, csid->irq, csid->res->hw_ops->isr,  in msm_csid_subdev_init()
1060 			       csid->irq_name, csid);  in msm_csid_subdev_init()
1068 	csid->nclocks = 0;  in msm_csid_subdev_init()
1069 	while (res->clock[csid->nclocks])  in msm_csid_subdev_init()
1070 		csid->nclocks++;  in msm_csid_subdev_init()
1072 	csid->clock = devm_kcalloc(dev, csid->nclocks, sizeof(*csid->clock),  in msm_csid_subdev_init()
1074 	if (!csid->clock)  in msm_csid_subdev_init()
1077 	for (i = 0; i < csid->nclocks; i++) {  in msm_csid_subdev_init()
1078 		struct camss_clock *clock = &csid->clock[i];  in msm_csid_subdev_init()
1109 			csid->num_supplies++;  in msm_csid_subdev_init()
1112 	if (csid->num_supplies) {  in msm_csid_subdev_init()
1113 		csid->supplies = devm_kmalloc_array(camss->dev,  in msm_csid_subdev_init()
1114 						    csid->num_supplies,  in msm_csid_subdev_init()
1115 						    sizeof(*csid->supplies),  in msm_csid_subdev_init()
1117 		if (!csid->supplies)  in msm_csid_subdev_init()
1121 	for (i = 0; i < csid->num_supplies; i++)  in msm_csid_subdev_init()
1122 		csid->supplies[i].supply = res->regulators[i];  in msm_csid_subdev_init()
1124 	ret = devm_regulator_bulk_get(camss->dev, csid->num_supplies,  in msm_csid_subdev_init()
1125 				      csid->supplies);  in msm_csid_subdev_init()
1129 	init_completion(&csid->reset_complete);  in msm_csid_subdev_init()
1135  * msm_csid_get_csid_id - Get CSID HW module id
1136  * @entity: Pointer to CSID media entity structure
1137  * @id: Return CSID HW module id here
1142 	struct csid_device *csid = v4l2_get_subdevdata(sd);  in msm_csid_get_csid_id()  local
1144 	*id = csid->id;  in msm_csid_get_csid_id()
1165  * csid_link_setup - Setup CSID connections
1184 		struct csid_device *csid;  in csid_link_setup()  local
1189 		csid = v4l2_get_subdevdata(sd);  in csid_link_setup()
1192 		/* do not allow a link from CSIPHY to CSID */  in csid_link_setup()
1193 		if (csid->testgen_mode->cur.val != 0)  in csid_link_setup()
1200 		/* do no allow a link from CSIPHY to CSID */  in csid_link_setup()
1204 		csid->phy.csiphy_id = csiphy->id;  in csid_link_setup()
1207 		csid->phy.lane_cnt = lane_cfg->num_data;  in csid_link_setup()
1208 		csid->phy.lane_assign = csid_get_lane_assign(lane_cfg);  in csid_link_setup()
1213 		struct csid_device *csid = v4l2_get_subdevdata(sd);  in csid_link_setup()  local
1214 		struct device *dev = csid->camss->dev;  in csid_link_setup()
1217 			csid->phy.en_vc |= BIT(local->index - 1);  in csid_link_setup()
1219 			csid->phy.en_vc &= ~BIT(local->index - 1);  in csid_link_setup()
1221 		csid->phy.need_vc_update = true;  in csid_link_setup()
1223 		dev_dbg(dev, "%s: Enabled CSID virtual channels mask 0x%x\n",  in csid_link_setup()
1224 			__func__, csid->phy.en_vc);  in csid_link_setup()
1263  * msm_csid_register_entity - Register subdev node for CSID module
1264  * @csid: CSID device
1269 int msm_csid_register_entity(struct csid_device *csid,  in msm_csid_register_entity()  argument
1272 	struct v4l2_subdev *sd = &csid->subdev;  in msm_csid_register_entity()
1273 	struct media_pad *pads = csid->pads;  in msm_csid_register_entity()
1274 	struct device *dev = csid->camss->dev;  in msm_csid_register_entity()
1283 		 MSM_CSID_NAME, csid->id);  in msm_csid_register_entity()
1284 	v4l2_set_subdevdata(sd, csid);  in msm_csid_register_entity()
1286 	ret = v4l2_ctrl_handler_init(&csid->ctrls, 1);  in msm_csid_register_entity()
1292 	csid->testgen_mode = v4l2_ctrl_new_std_menu_items(&csid->ctrls,  in msm_csid_register_entity()
1294 				csid->testgen.nmodes, 0, 0,  in msm_csid_register_entity()
1295 				csid->testgen.modes);  in msm_csid_register_entity()
1297 	if (csid->ctrls.error) {  in msm_csid_register_entity()
1298 		dev_err(dev, "Failed to init ctrl: %d\n", csid->ctrls.error);  in msm_csid_register_entity()
1299 		ret = csid->ctrls.error;  in msm_csid_register_entity()
1303 	csid->subdev.ctrl_handler = &csid->ctrls;  in msm_csid_register_entity()
1334 	v4l2_ctrl_handler_free(&csid->ctrls);  in msm_csid_register_entity()
1340  * msm_csid_unregister_entity - Unregister CSID module subdev node
1341  * @csid: CSID device
1343 void msm_csid_unregister_entity(struct csid_device *csid)  in msm_csid_unregister_entity()  argument
1345 	v4l2_device_unregister_subdev(&csid->subdev);  in msm_csid_unregister_entity()
1346 	media_entity_cleanup(&csid->subdev.entity);  in msm_csid_unregister_entity()
1347 	v4l2_ctrl_handler_free(&csid->ctrls);  in msm_csid_unregister_entity()
1350 inline bool csid_is_lite(struct csid_device *csid)  in csid_is_lite()  argument
1352 	return csid->camss->res->csid_res[csid->id].csid.is_lite;  in csid_is_lite()