134 static void __xtpg_update_pattern_control(struct xtpg_device *xtpg,  in __xtpg_update_pattern_control()  argument
137 	u32 pattern_mask = (1 << (xtpg->pattern->maximum + 1)) - 1;  in __xtpg_update_pattern_control()
143 	if (xtpg->npads == 1 || !xtpg->has_input)  in __xtpg_update_pattern_control()
154 	__v4l2_ctrl_modify_range(xtpg->pattern, 0, xtpg->pattern->maximum,  in __xtpg_update_pattern_control()
158 static void xtpg_update_pattern_control(struct xtpg_device *xtpg,  in xtpg_update_pattern_control()  argument
161 	mutex_lock(xtpg->ctrl_handler.lock);  in xtpg_update_pattern_control()
162 	__xtpg_update_pattern_control(xtpg, passthrough, pattern);  in xtpg_update_pattern_control()
163 	mutex_unlock(xtpg->ctrl_handler.lock);  in xtpg_update_pattern_control()
172 	struct xtpg_device *xtpg = to_tpg(subdev);  in xtpg_s_stream()  local
173 	unsigned int width = xtpg->formats[0].width;  in xtpg_s_stream()
174 	unsigned int height = xtpg->formats[0].height;  in xtpg_s_stream()
179 		xvip_stop(&xtpg->xvip);  in xtpg_s_stream()
180 		if (xtpg->vtc)  in xtpg_s_stream()
181 			xvtc_generator_stop(xtpg->vtc);  in xtpg_s_stream()
183 		xtpg_update_pattern_control(xtpg, true, true);  in xtpg_s_stream()
184 		xtpg->streaming = false;  in xtpg_s_stream()
188 	xvip_set_frame_size(&xtpg->xvip, &xtpg->formats[0]);  in xtpg_s_stream()
190 	if (xtpg->vtc) {  in xtpg_s_stream()
201 			       v4l2_ctrl_g_ctrl(xtpg->hblank) + width);  in xtpg_s_stream()
203 			       v4l2_ctrl_g_ctrl(xtpg->vblank) + height);  in xtpg_s_stream()
210 		xvtc_generator_start(xtpg->vtc, &config);  in xtpg_s_stream()
219 	mutex_lock(xtpg->ctrl_handler.lock);  in xtpg_s_stream()
221 	xvip_clr_and_set(&xtpg->xvip, XTPG_PATTERN_CONTROL,  in xtpg_s_stream()
222 			 XTPG_PATTERN_MASK, xtpg->pattern->cur.val);  in xtpg_s_stream()
228 	passthrough = xtpg->pattern->cur.val == 0;  in xtpg_s_stream()
229 	__xtpg_update_pattern_control(xtpg, passthrough, !passthrough);  in xtpg_s_stream()
231 	xtpg->streaming = true;  in xtpg_s_stream()
233 	mutex_unlock(xtpg->ctrl_handler.lock);  in xtpg_s_stream()
240 		    : xtpg_get_bayer_phase(xtpg->formats[0].code);  in xtpg_s_stream()
241 	xvip_write(&xtpg->xvip, XTPG_BAYER_PHASE, bayer_phase);  in xtpg_s_stream()
243 	if (xtpg->vtmux_gpio)  in xtpg_s_stream()
244 		gpiod_set_value_cansleep(xtpg->vtmux_gpio, !passthrough);  in xtpg_s_stream()
246 	xvip_start(&xtpg->xvip);  in xtpg_s_stream()
256 __xtpg_get_pad_format(struct xtpg_device *xtpg,  in __xtpg_get_pad_format()  argument
262 		return v4l2_subdev_get_try_format(&xtpg->xvip.subdev, cfg, pad);  in __xtpg_get_pad_format()
264 		return &xtpg->formats[pad];  in __xtpg_get_pad_format()
274 	struct xtpg_device *xtpg = to_tpg(subdev);  in xtpg_get_format()  local
276 	fmt->format = *__xtpg_get_pad_format(xtpg, cfg, fmt->pad, fmt->which);  in xtpg_get_format()
285 	struct xtpg_device *xtpg = to_tpg(subdev);  in xtpg_set_format()  local
289 	__format = __xtpg_get_pad_format(xtpg, cfg, fmt->pad, fmt->which);  in xtpg_set_format()
294 	if (xtpg->npads == 2 && fmt->pad == 1) {  in xtpg_set_format()
300 	if (xtpg->bayer) {  in xtpg_set_format()
311 	if (xtpg->npads == 2) {  in xtpg_set_format()
312 		__format = __xtpg_get_pad_format(xtpg, cfg, 1, fmt->which);  in xtpg_set_format()
354 	struct xtpg_device *xtpg = to_tpg(subdev);  in xtpg_open()  local
358 	*format = xtpg->default_format;  in xtpg_open()
360 	if (xtpg->npads == 2) {  in xtpg_open()
362 		*format = xtpg->default_format;  in xtpg_open()
375 	struct xtpg_device *xtpg = container_of(ctrl->handler,  in xtpg_s_ctrl()  local
380 		xvip_clr_and_set(&xtpg->xvip, XTPG_PATTERN_CONTROL,  in xtpg_s_ctrl()
384 		xvip_clr_or_set(&xtpg->xvip, XTPG_PATTERN_CONTROL,  in xtpg_s_ctrl()
388 		xvip_clr_or_set(&xtpg->xvip, XTPG_PATTERN_CONTROL,  in xtpg_s_ctrl()
392 		xvip_clr_and_set(&xtpg->xvip, XTPG_PATTERN_CONTROL,  in xtpg_s_ctrl()
398 		xvip_clr_or_set(&xtpg->xvip, XTPG_PATTERN_CONTROL,  in xtpg_s_ctrl()
402 		xvip_clr_or_set(&xtpg->xvip, XTPG_PATTERN_CONTROL,  in xtpg_s_ctrl()
406 		xvip_clr_or_set(&xtpg->xvip, XTPG_PATTERN_CONTROL,  in xtpg_s_ctrl()
410 		xvip_write(&xtpg->xvip, XTPG_MOTION_SPEED, ctrl->val);  in xtpg_s_ctrl()
413 		xvip_clr_and_set(&xtpg->xvip, XTPG_CROSS_HAIRS,  in xtpg_s_ctrl()
418 		xvip_clr_and_set(&xtpg->xvip, XTPG_CROSS_HAIRS,  in xtpg_s_ctrl()
423 		xvip_clr_and_set(&xtpg->xvip, XTPG_ZPLATE_HOR_CONTROL,  in xtpg_s_ctrl()
428 		xvip_clr_and_set(&xtpg->xvip, XTPG_ZPLATE_HOR_CONTROL,  in xtpg_s_ctrl()
433 		xvip_clr_and_set(&xtpg->xvip, XTPG_ZPLATE_VER_CONTROL,  in xtpg_s_ctrl()
438 		xvip_clr_and_set(&xtpg->xvip, XTPG_ZPLATE_VER_CONTROL,  in xtpg_s_ctrl()
443 		xvip_write(&xtpg->xvip, XTPG_BOX_SIZE, ctrl->val);  in xtpg_s_ctrl()
446 		xvip_write(&xtpg->xvip, XTPG_BOX_COLOR, ctrl->val);  in xtpg_s_ctrl()
449 		xvip_write(&xtpg->xvip, XTPG_STUCK_PIXEL_THRESH, ctrl->val);  in xtpg_s_ctrl()
452 		xvip_write(&xtpg->xvip, XTPG_NOISE_GAIN, ctrl->val);  in xtpg_s_ctrl()
691 	struct xtpg_device *xtpg = dev_get_drvdata(dev);  in xtpg_pm_suspend()  local
693 	xvip_suspend(&xtpg->xvip);  in xtpg_pm_suspend()
700 	struct xtpg_device *xtpg = dev_get_drvdata(dev);  in xtpg_pm_resume()  local
702 	xvip_resume(&xtpg->xvip);  in xtpg_pm_resume()
711 static int xtpg_parse_of(struct xtpg_device *xtpg)  in xtpg_parse_of()  argument
713 	struct device *dev = xtpg->xvip.dev;  in xtpg_parse_of()
714 	struct device_node *node = xtpg->xvip.dev->of_node;  in xtpg_parse_of()
738 		if (!xtpg->vip_format) {  in xtpg_parse_of()
739 			xtpg->vip_format = format;  in xtpg_parse_of()
740 		} else if (xtpg->vip_format != format) {  in xtpg_parse_of()
761 	xtpg->npads = nports;  in xtpg_parse_of()
763 		xtpg->has_input = true;  in xtpg_parse_of()
771 	struct xtpg_device *xtpg;  in xtpg_probe()  local
775 	xtpg = devm_kzalloc(&pdev->dev, sizeof(*xtpg), GFP_KERNEL);  in xtpg_probe()
776 	if (!xtpg)  in xtpg_probe()
779 	xtpg->xvip.dev = &pdev->dev;  in xtpg_probe()
781 	ret = xtpg_parse_of(xtpg);  in xtpg_probe()
785 	ret = xvip_init_resources(&xtpg->xvip);  in xtpg_probe()
789 	xtpg->vtmux_gpio = devm_gpiod_get_optional(&pdev->dev, "timing",  in xtpg_probe()
791 	if (IS_ERR(xtpg->vtmux_gpio)) {  in xtpg_probe()
792 		ret = PTR_ERR(xtpg->vtmux_gpio);  in xtpg_probe()
796 	xtpg->vtc = xvtc_of_get(pdev->dev.of_node);  in xtpg_probe()
797 	if (IS_ERR(xtpg->vtc)) {  in xtpg_probe()
798 		ret = PTR_ERR(xtpg->vtc);  in xtpg_probe()
803 	xvip_reset(&xtpg->xvip);  in xtpg_probe()
808 	if (xtpg->npads == 2) {  in xtpg_probe()
809 		xtpg->pads[0].flags = MEDIA_PAD_FL_SINK;  in xtpg_probe()
810 		xtpg->pads[1].flags = MEDIA_PAD_FL_SOURCE;  in xtpg_probe()
812 		xtpg->pads[0].flags = MEDIA_PAD_FL_SOURCE;  in xtpg_probe()
816 	xtpg->default_format.code = xtpg->vip_format->code;  in xtpg_probe()
817 	xtpg->default_format.field = V4L2_FIELD_NONE;  in xtpg_probe()
818 	xtpg->default_format.colorspace = V4L2_COLORSPACE_SRGB;  in xtpg_probe()
819 	xvip_get_frame_size(&xtpg->xvip, &xtpg->default_format);  in xtpg_probe()
821 	bayer_phase = xtpg_get_bayer_phase(xtpg->vip_format->code);  in xtpg_probe()
823 		xtpg->bayer = true;  in xtpg_probe()
825 	xtpg->formats[0] = xtpg->default_format;  in xtpg_probe()
826 	if (xtpg->npads == 2)  in xtpg_probe()
827 		xtpg->formats[1] = xtpg->default_format;  in xtpg_probe()
830 	subdev = &xtpg->xvip.subdev;  in xtpg_probe()
835 	v4l2_set_subdevdata(subdev, xtpg);  in xtpg_probe()
839 	ret = media_entity_init(&subdev->entity, xtpg->npads, xtpg->pads, 0);  in xtpg_probe()
843 	v4l2_ctrl_handler_init(&xtpg->ctrl_handler, 3 + ARRAY_SIZE(xtpg_ctrls));  in xtpg_probe()
845 	xtpg->vblank = v4l2_ctrl_new_std(&xtpg->ctrl_handler, &xtpg_ctrl_ops,  in xtpg_probe()
848 	xtpg->hblank = v4l2_ctrl_new_std(&xtpg->ctrl_handler, &xtpg_ctrl_ops,  in xtpg_probe()
851 	xtpg->pattern = v4l2_ctrl_new_std_menu_items(&xtpg->ctrl_handler,  in xtpg_probe()
857 		v4l2_ctrl_new_custom(&xtpg->ctrl_handler, &xtpg_ctrls[i], NULL);  in xtpg_probe()
859 	if (xtpg->ctrl_handler.error) {  in xtpg_probe()
861 		ret = xtpg->ctrl_handler.error;  in xtpg_probe()
864 	subdev->ctrl_handler = &xtpg->ctrl_handler;  in xtpg_probe()
866 	xtpg_update_pattern_control(xtpg, true, true);  in xtpg_probe()
868 	ret = v4l2_ctrl_handler_setup(&xtpg->ctrl_handler);  in xtpg_probe()
874 	platform_set_drvdata(pdev, xtpg);  in xtpg_probe()
876 	xvip_print_version(&xtpg->xvip);  in xtpg_probe()
887 	v4l2_ctrl_handler_free(&xtpg->ctrl_handler);  in xtpg_probe()
889 	xvtc_put(xtpg->vtc);  in xtpg_probe()
891 	xvip_cleanup_resources(&xtpg->xvip);  in xtpg_probe()
897 	struct xtpg_device *xtpg = platform_get_drvdata(pdev);  in xtpg_remove()  local
898 	struct v4l2_subdev *subdev = &xtpg->xvip.subdev;  in xtpg_remove()
901 	v4l2_ctrl_handler_free(&xtpg->ctrl_handler);  in xtpg_remove()
904 	xvip_cleanup_resources(&xtpg->xvip);  in xtpg_remove()