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(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 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(&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 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 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