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 | |
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(size: 2049, GFP_KERNEL); |
25 | if (itv->vbi.sliced_mpeg_data[i] == NULL) { |
26 | while (--i >= 0) { |
27 | kfree(objp: 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(fmt: 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(fmt: itv->vbi.sliced_in, is_pal: itv->is_50hz); |
47 | } |
48 | return 0; |
49 | } |
50 | |
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 | |
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 | |
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 | |
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(v: &itv->decoding)) { |
107 | if (ivtv_api(itv, CX2341X_DEC_GET_TIMING_INFO, args: 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, addr: &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 | |
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, pts: itv->ctrl_pts->p_new.p_s64, |
129 | frame: itv->ctrl_frame->p_new.p_s64); |
130 | } |
131 | return 0; |
132 | } |
133 | |
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, args: 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 | |