1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3     ioctl control functions
4     Copyright (C) 2003-2004  Kevin Thayer <nufan_wfk at yahoo.com>
5     Copyright (C) 2005-2007  Hans Verkuil <hverkuil@xs4all.nl>
6 
7  */
8 
9 #include "ivtv-driver.h"
10 #include "ivtv-ioctl.h"
11 #include "ivtv-controls.h"
12 #include "ivtv-mailbox.h"
13 
ivtv_s_stream_vbi_fmt(struct cx2341x_handler * cxhdl,u32 fmt)14 static int ivtv_s_stream_vbi_fmt(struct cx2341x_handler *cxhdl, u32 fmt)
15 {
16 	struct ivtv *itv = container_of(cxhdl, struct ivtv, cxhdl);
17 
18 	/* First try to allocate sliced VBI buffers if needed. */
19 	if (fmt && itv->vbi.sliced_mpeg_data[0] == NULL) {
20 		int i;
21 
22 		for (i = 0; i < IVTV_VBI_FRAMES; i++) {
23 			/* Yuck, hardcoded. Needs to be a define */
24 			itv->vbi.sliced_mpeg_data[i] = kmalloc(2049, GFP_KERNEL);
25 			if (itv->vbi.sliced_mpeg_data[i] == NULL) {
26 				while (--i >= 0) {
27 					kfree(itv->vbi.sliced_mpeg_data[i]);
28 					itv->vbi.sliced_mpeg_data[i] = NULL;
29 				}
30 				return -ENOMEM;
31 			}
32 		}
33 	}
34 
35 	itv->vbi.insert_mpeg = fmt;
36 
37 	if (itv->vbi.insert_mpeg == 0) {
38 		return 0;
39 	}
40 	/* Need sliced data for mpeg insertion */
41 	if (ivtv_get_service_set(itv->vbi.sliced_in) == 0) {
42 		if (itv->is_60hz)
43 			itv->vbi.sliced_in->service_set = V4L2_SLICED_CAPTION_525;
44 		else
45 			itv->vbi.sliced_in->service_set = V4L2_SLICED_WSS_625;
46 		ivtv_expand_service_set(itv->vbi.sliced_in, itv->is_50hz);
47 	}
48 	return 0;
49 }
50 
ivtv_s_video_encoding(struct cx2341x_handler * cxhdl,u32 val)51 static int ivtv_s_video_encoding(struct cx2341x_handler *cxhdl, u32 val)
52 {
53 	struct ivtv *itv = container_of(cxhdl, struct ivtv, cxhdl);
54 	int is_mpeg1 = val == V4L2_MPEG_VIDEO_ENCODING_MPEG_1;
55 	struct v4l2_subdev_format format = {
56 		.which = V4L2_SUBDEV_FORMAT_ACTIVE,
57 	};
58 
59 	/* fix videodecoder resolution */
60 	format.format.width = cxhdl->width / (is_mpeg1 ? 2 : 1);
61 	format.format.height = cxhdl->height;
62 	format.format.code = MEDIA_BUS_FMT_FIXED;
63 	v4l2_subdev_call(itv->sd_video, pad, set_fmt, NULL, &format);
64 	return 0;
65 }
66 
ivtv_s_audio_sampling_freq(struct cx2341x_handler * cxhdl,u32 idx)67 static int ivtv_s_audio_sampling_freq(struct cx2341x_handler *cxhdl, u32 idx)
68 {
69 	static const u32 freqs[3] = { 44100, 48000, 32000 };
70 	struct ivtv *itv = container_of(cxhdl, struct ivtv, cxhdl);
71 
72 	/* The audio clock of the digitizer must match the codec sample
73 	   rate otherwise you get some very strange effects. */
74 	if (idx < ARRAY_SIZE(freqs))
75 		ivtv_call_all(itv, audio, s_clock_freq, freqs[idx]);
76 	return 0;
77 }
78 
ivtv_s_audio_mode(struct cx2341x_handler * cxhdl,u32 val)79 static int ivtv_s_audio_mode(struct cx2341x_handler *cxhdl, u32 val)
80 {
81 	struct ivtv *itv = container_of(cxhdl, struct ivtv, cxhdl);
82 
83 	itv->dualwatch_stereo_mode = val;
84 	return 0;
85 }
86 
87 const struct cx2341x_handler_ops ivtv_cxhdl_ops = {
88 	.s_audio_mode = ivtv_s_audio_mode,
89 	.s_audio_sampling_freq = ivtv_s_audio_sampling_freq,
90 	.s_video_encoding = ivtv_s_video_encoding,
91 	.s_stream_vbi_fmt = ivtv_s_stream_vbi_fmt,
92 };
93 
ivtv_g_pts_frame(struct ivtv * itv,s64 * pts,s64 * frame)94 int ivtv_g_pts_frame(struct ivtv *itv, s64 *pts, s64 *frame)
95 {
96 	u32 data[CX2341X_MBOX_MAX_DATA];
97 
98 	if (test_bit(IVTV_F_I_VALID_DEC_TIMINGS, &itv->i_flags)) {
99 		*pts = (s64)((u64)itv->last_dec_timing[2] << 32) |
100 			(u64)itv->last_dec_timing[1];
101 		*frame = itv->last_dec_timing[0];
102 		return 0;
103 	}
104 	*pts = 0;
105 	*frame = 0;
106 	if (atomic_read(&itv->decoding)) {
107 		if (ivtv_api(itv, CX2341X_DEC_GET_TIMING_INFO, 5, data)) {
108 			IVTV_DEBUG_WARN("GET_TIMING: couldn't read clock\n");
109 			return -EIO;
110 		}
111 		memcpy(itv->last_dec_timing, data, sizeof(itv->last_dec_timing));
112 		set_bit(IVTV_F_I_VALID_DEC_TIMINGS, &itv->i_flags);
113 		*pts = (s64)((u64) data[2] << 32) | (u64) data[1];
114 		*frame = data[0];
115 		/*timing->scr = (u64) (((u64) data[4] << 32) | (u64) (data[3]));*/
116 	}
117 	return 0;
118 }
119 
ivtv_g_volatile_ctrl(struct v4l2_ctrl * ctrl)120 static int ivtv_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
121 {
122 	struct ivtv *itv = container_of(ctrl->handler, struct ivtv, cxhdl.hdl);
123 
124 	switch (ctrl->id) {
125 	/* V4L2_CID_MPEG_VIDEO_DEC_PTS and V4L2_CID_MPEG_VIDEO_DEC_FRAME
126 	   control cluster */
127 	case V4L2_CID_MPEG_VIDEO_DEC_PTS:
128 		return ivtv_g_pts_frame(itv, itv->ctrl_pts->p_new.p_s64,
129 					     itv->ctrl_frame->p_new.p_s64);
130 	}
131 	return 0;
132 }
133 
ivtv_s_ctrl(struct v4l2_ctrl * ctrl)134 static int ivtv_s_ctrl(struct v4l2_ctrl *ctrl)
135 {
136 	struct ivtv *itv = container_of(ctrl->handler, struct ivtv, cxhdl.hdl);
137 
138 	switch (ctrl->id) {
139 	/* V4L2_CID_MPEG_AUDIO_DEC_PLAYBACK and MULTILINGUAL_PLAYBACK
140 	   control cluster */
141 	case V4L2_CID_MPEG_AUDIO_DEC_PLAYBACK:
142 		itv->audio_stereo_mode = itv->ctrl_audio_playback->val - 1;
143 		itv->audio_bilingual_mode = itv->ctrl_audio_multilingual_playback->val - 1;
144 		ivtv_vapi(itv, CX2341X_DEC_SET_AUDIO_MODE, 2, itv->audio_bilingual_mode, itv->audio_stereo_mode);
145 		break;
146 	}
147 	return 0;
148 }
149 
150 const struct v4l2_ctrl_ops ivtv_hdl_out_ops = {
151 	.s_ctrl = ivtv_s_ctrl,
152 	.g_volatile_ctrl = ivtv_g_volatile_ctrl,
153 };
154