131 static void __xtpg_update_pattern_control(struct xtpg_device *xtpg,  in __xtpg_update_pattern_control()  argument
134 	u32 pattern_mask = (1 << (xtpg->pattern->maximum + 1)) - 1;  in __xtpg_update_pattern_control()
140 	if (xtpg->npads == 1 || !xtpg->has_input)  in __xtpg_update_pattern_control()
151 	__v4l2_ctrl_modify_range(xtpg->pattern, 0, xtpg->pattern->maximum,  in __xtpg_update_pattern_control()
155 static void xtpg_update_pattern_control(struct xtpg_device *xtpg,  in xtpg_update_pattern_control()  argument
158 	mutex_lock(xtpg->ctrl_handler.lock);  in xtpg_update_pattern_control()
159 	__xtpg_update_pattern_control(xtpg, passthrough, pattern);  in xtpg_update_pattern_control()
160 	mutex_unlock(xtpg->ctrl_handler.lock);  in xtpg_update_pattern_control()
169 	struct xtpg_device *xtpg = to_tpg(subdev);  in xtpg_s_stream()  local
170 	unsigned int width = xtpg->formats[0].width;  in xtpg_s_stream()
171 	unsigned int height = xtpg->formats[0].height;  in xtpg_s_stream()
176 		xvip_stop(&xtpg->xvip);  in xtpg_s_stream()
177 		if (xtpg->vtc)  in xtpg_s_stream()
178 			xvtc_generator_stop(xtpg->vtc);  in xtpg_s_stream()
180 		xtpg_update_pattern_control(xtpg, true, true);  in xtpg_s_stream()
181 		xtpg->streaming = false;  in xtpg_s_stream()
185 	xvip_set_frame_size(&xtpg->xvip, &xtpg->formats[0]);  in xtpg_s_stream()
187 	if (xtpg->vtc) {  in xtpg_s_stream()
198 			       v4l2_ctrl_g_ctrl(xtpg->hblank) + width);  in xtpg_s_stream()
200 			       v4l2_ctrl_g_ctrl(xtpg->vblank) + height);  in xtpg_s_stream()
207 		xvtc_generator_start(xtpg->vtc, &config);  in xtpg_s_stream()
216 	mutex_lock(xtpg->ctrl_handler.lock);  in xtpg_s_stream()
218 	xvip_clr_and_set(&xtpg->xvip, XTPG_PATTERN_CONTROL,  in xtpg_s_stream()
219 			 XTPG_PATTERN_MASK, xtpg->pattern->cur.val);  in xtpg_s_stream()
225 	passthrough = xtpg->pattern->cur.val == 0;  in xtpg_s_stream()
226 	__xtpg_update_pattern_control(xtpg, passthrough, !passthrough);  in xtpg_s_stream()
228 	xtpg->streaming = true;  in xtpg_s_stream()
230 	mutex_unlock(xtpg->ctrl_handler.lock);  in xtpg_s_stream()
237 		    : xtpg_get_bayer_phase(xtpg->formats[0].code);  in xtpg_s_stream()
238 	xvip_write(&xtpg->xvip, XTPG_BAYER_PHASE, bayer_phase);  in xtpg_s_stream()
240 	if (xtpg->vtmux_gpio)  in xtpg_s_stream()
241 		gpiod_set_value_cansleep(xtpg->vtmux_gpio, !passthrough);  in xtpg_s_stream()
243 	xvip_start(&xtpg->xvip);  in xtpg_s_stream()
253 __xtpg_get_pad_format(struct xtpg_device *xtpg,  in __xtpg_get_pad_format()  argument
259 		return v4l2_subdev_get_try_format(&xtpg->xvip.subdev,  in __xtpg_get_pad_format()
262 		return &xtpg->formats[pad];  in __xtpg_get_pad_format()
272 	struct xtpg_device *xtpg = to_tpg(subdev);  in xtpg_get_format()  local
274 	fmt->format = *__xtpg_get_pad_format(xtpg, sd_state, fmt->pad,  in xtpg_get_format()
284 	struct xtpg_device *xtpg = to_tpg(subdev);  in xtpg_set_format()  local
288 	__format = __xtpg_get_pad_format(xtpg, sd_state, fmt->pad, fmt->which);  in xtpg_set_format()
293 	if (xtpg->npads == 2 && fmt->pad == 1) {  in xtpg_set_format()
299 	if (xtpg->bayer) {  in xtpg_set_format()
310 	if (xtpg->npads == 2) {  in xtpg_set_format()
311 		__format = __xtpg_get_pad_format(xtpg, sd_state, 1,  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()
739 		if (!xtpg->vip_format) {  in xtpg_parse_of()
740 			xtpg->vip_format = format;  in xtpg_parse_of()
741 		} else if (xtpg->vip_format != format) {  in xtpg_parse_of()
763 	xtpg->npads = nports;  in xtpg_parse_of()
765 		xtpg->has_input = true;  in xtpg_parse_of()
773 	struct xtpg_device *xtpg;  in xtpg_probe()  local
777 	xtpg = devm_kzalloc(&pdev->dev, sizeof(*xtpg), GFP_KERNEL);  in xtpg_probe()
778 	if (!xtpg)  in xtpg_probe()
781 	xtpg->xvip.dev = &pdev->dev;  in xtpg_probe()
783 	ret = xtpg_parse_of(xtpg);  in xtpg_probe()
787 	ret = xvip_init_resources(&xtpg->xvip);  in xtpg_probe()
791 	xtpg->vtmux_gpio = devm_gpiod_get_optional(&pdev->dev, "timing",  in xtpg_probe()
793 	if (IS_ERR(xtpg->vtmux_gpio)) {  in xtpg_probe()
794 		ret = PTR_ERR(xtpg->vtmux_gpio);  in xtpg_probe()
798 	xtpg->vtc = xvtc_of_get(pdev->dev.of_node);  in xtpg_probe()
799 	if (IS_ERR(xtpg->vtc)) {  in xtpg_probe()
800 		ret = PTR_ERR(xtpg->vtc);  in xtpg_probe()
805 	xvip_reset(&xtpg->xvip);  in xtpg_probe()
810 	if (xtpg->npads == 2) {  in xtpg_probe()
811 		xtpg->pads[0].flags = MEDIA_PAD_FL_SINK;  in xtpg_probe()
812 		xtpg->pads[1].flags = MEDIA_PAD_FL_SOURCE;  in xtpg_probe()
814 		xtpg->pads[0].flags = MEDIA_PAD_FL_SOURCE;  in xtpg_probe()
818 	xtpg->default_format.code = xtpg->vip_format->code;  in xtpg_probe()
819 	xtpg->default_format.field = V4L2_FIELD_NONE;  in xtpg_probe()
820 	xtpg->default_format.colorspace = V4L2_COLORSPACE_SRGB;  in xtpg_probe()
821 	xvip_get_frame_size(&xtpg->xvip, &xtpg->default_format);  in xtpg_probe()
823 	bayer_phase = xtpg_get_bayer_phase(xtpg->vip_format->code);  in xtpg_probe()
825 		xtpg->bayer = true;  in xtpg_probe()
827 	xtpg->formats[0] = xtpg->default_format;  in xtpg_probe()
828 	if (xtpg->npads == 2)  in xtpg_probe()
829 		xtpg->formats[1] = xtpg->default_format;  in xtpg_probe()
832 	subdev = &xtpg->xvip.subdev;  in xtpg_probe()
837 	v4l2_set_subdevdata(subdev, xtpg);  in xtpg_probe()
841 	ret = media_entity_pads_init(&subdev->entity, xtpg->npads, xtpg->pads);  in xtpg_probe()
845 	v4l2_ctrl_handler_init(&xtpg->ctrl_handler, 3 + ARRAY_SIZE(xtpg_ctrls));  in xtpg_probe()
847 	xtpg->vblank = v4l2_ctrl_new_std(&xtpg->ctrl_handler, &xtpg_ctrl_ops,  in xtpg_probe()
850 	xtpg->hblank = v4l2_ctrl_new_std(&xtpg->ctrl_handler, &xtpg_ctrl_ops,  in xtpg_probe()
853 	xtpg->pattern = v4l2_ctrl_new_std_menu_items(&xtpg->ctrl_handler,  in xtpg_probe()
859 		v4l2_ctrl_new_custom(&xtpg->ctrl_handler, &xtpg_ctrls[i], NULL);  in xtpg_probe()
861 	if (xtpg->ctrl_handler.error) {  in xtpg_probe()
863 		ret = xtpg->ctrl_handler.error;  in xtpg_probe()
866 	subdev->ctrl_handler = &xtpg->ctrl_handler;  in xtpg_probe()
868 	xtpg_update_pattern_control(xtpg, true, true);  in xtpg_probe()
870 	ret = v4l2_ctrl_handler_setup(&xtpg->ctrl_handler);  in xtpg_probe()
876 	platform_set_drvdata(pdev, xtpg);  in xtpg_probe()
878 	xvip_print_version(&xtpg->xvip);  in xtpg_probe()
889 	v4l2_ctrl_handler_free(&xtpg->ctrl_handler);  in xtpg_probe()
891 	xvtc_put(xtpg->vtc);  in xtpg_probe()
893 	xvip_cleanup_resources(&xtpg->xvip);  in xtpg_probe()
899 	struct xtpg_device *xtpg = platform_get_drvdata(pdev);  in xtpg_remove()  local
900 	struct v4l2_subdev *subdev = &xtpg->xvip.subdev;  in xtpg_remove()
903 	v4l2_ctrl_handler_free(&xtpg->ctrl_handler);  in xtpg_remove()
906 	xvip_cleanup_resources(&xtpg->xvip);  in xtpg_remove()