cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

ivtv-controls.c (4496B)

      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
     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		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
     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 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
     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_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
    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_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
    150const struct v4l2_ctrl_ops ivtv_hdl_out_ops = {
    151	.s_ctrl = ivtv_s_ctrl,
    152	.g_volatile_ctrl = ivtv_g_volatile_ctrl,
    153};