154 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 ioctl control functions4 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 14static 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 else45 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 51static 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 67static 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 sample73 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 79static 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 87const 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 94int 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 120static 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_FRAME126 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 134static 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_PLAYBACK140 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 150const struct v4l2_ctrl_ops ivtv_hdl_out_ops = {151 .s_ctrl = ivtv_s_ctrl,152 .g_volatile_ctrl = ivtv_g_volatile_ctrl,153};154