cx18-controls.c

  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 *  cx18 ioctl control functions
  4 *
  5 *  Derived from ivtv-controls.c
  6 *
  7 *  Copyright (C) 2007  Hans Verkuil <hverkuil@kernel.org>
  8 */
  9#include <linux/kernel.h>
 10#include <linux/slab.h>
 11
 12#include "cx18-driver.h"
 13#include "cx18-cards.h"
 14#include "cx18-ioctl.h"
 15#include "cx18-audio.h"
 16#include "cx18-mailbox.h"
 17#include "cx18-controls.h"
 18
 19static int cx18_s_stream_vbi_fmt(struct cx2341x_handler *cxhdl, u32 fmt)
 20{
 21	struct cx18 *cx = container_of(cxhdl, struct cx18, cxhdl);
 22	int type = cxhdl->stream_type->val;
 23
 24	if (atomic_read(&cx->ana_capturing) > 0)
 25		return -EBUSY;
 26
 27	if (fmt != V4L2_MPEG_STREAM_VBI_FMT_IVTV ||
 28	    !(type == V4L2_MPEG_STREAM_TYPE_MPEG2_PS ||
 29	      type == V4L2_MPEG_STREAM_TYPE_MPEG2_DVD ||
 30	      type == V4L2_MPEG_STREAM_TYPE_MPEG2_SVCD)) {
 31		/* Only IVTV fmt VBI insertion & only MPEG-2 PS type streams */
 32		cx->vbi.insert_mpeg = V4L2_MPEG_STREAM_VBI_FMT_NONE;
 33		CX18_DEBUG_INFO("disabled insertion of sliced VBI data into the MPEG stream\n");
 34		return 0;
 35	}
 36
 37	/* Allocate sliced VBI buffers if needed. */
 38	if (cx->vbi.sliced_mpeg_data[0] == NULL) {
 39		int i;
 40
 41		for (i = 0; i < CX18_VBI_FRAMES; i++) {
 42			cx->vbi.sliced_mpeg_data[i] =
 43			       kmalloc(CX18_SLICED_MPEG_DATA_BUFSZ, GFP_KERNEL);
 44			if (cx->vbi.sliced_mpeg_data[i] == NULL) {
 45				while (--i >= 0) {
 46					kfree(cx->vbi.sliced_mpeg_data[i]);
 47					cx->vbi.sliced_mpeg_data[i] = NULL;
 48				}
 49				cx->vbi.insert_mpeg =
 50						  V4L2_MPEG_STREAM_VBI_FMT_NONE;
 51				CX18_WARN("Unable to allocate buffers for sliced VBI data insertion\n");
 52				return -ENOMEM;
 53			}
 54		}
 55	}
 56
 57	cx->vbi.insert_mpeg = fmt;
 58	CX18_DEBUG_INFO("enabled insertion of sliced VBI data into the MPEG PS,when sliced VBI is enabled\n");
 59
 60	/*
 61	 * If our current settings have no lines set for capture, store a valid,
 62	 * default set of service lines to capture, in our current settings.
 63	 */
 64	if (cx18_get_service_set(cx->vbi.sliced_in) == 0) {
 65		if (cx->is_60hz)
 66			cx->vbi.sliced_in->service_set =
 67							V4L2_SLICED_CAPTION_525;
 68		else
 69			cx->vbi.sliced_in->service_set = V4L2_SLICED_WSS_625;
 70		cx18_expand_service_set(cx->vbi.sliced_in, cx->is_50hz);
 71	}
 72	return 0;
 73}
 74
 75static int cx18_s_video_encoding(struct cx2341x_handler *cxhdl, u32 val)
 76{
 77	struct cx18 *cx = container_of(cxhdl, struct cx18, cxhdl);
 78	int is_mpeg1 = val == V4L2_MPEG_VIDEO_ENCODING_MPEG_1;
 79	struct v4l2_subdev_format format = {
 80		.which = V4L2_SUBDEV_FORMAT_ACTIVE,
 81	};
 82	struct v4l2_mbus_framefmt *fmt = &format.format;
 83
 84	/* fix videodecoder resolution */
 85	fmt->width = cxhdl->width / (is_mpeg1 ? 2 : 1);
 86	fmt->height = cxhdl->height;
 87	fmt->code = MEDIA_BUS_FMT_FIXED;
 88	v4l2_subdev_call(cx->sd_av, pad, set_fmt, NULL, &format);
 89	return 0;
 90}
 91
 92static int cx18_s_audio_sampling_freq(struct cx2341x_handler *cxhdl, u32 idx)
 93{
 94	static const u32 freqs[3] = { 44100, 48000, 32000 };
 95	struct cx18 *cx = container_of(cxhdl, struct cx18, cxhdl);
 96
 97	/* The audio clock of the digitizer must match the codec sample
 98	   rate otherwise you get some very strange effects. */
 99	if (idx < ARRAY_SIZE(freqs))
100		cx18_call_all(cx, audio, s_clock_freq, freqs[idx]);
101	return 0;
102}
103
104static int cx18_s_audio_mode(struct cx2341x_handler *cxhdl, u32 val)
105{
106	struct cx18 *cx = container_of(cxhdl, struct cx18, cxhdl);
107
108	cx->dualwatch_stereo_mode = val;
109	return 0;
110}
111
112const struct cx2341x_handler_ops cx18_cxhdl_ops = {
113	.s_audio_mode = cx18_s_audio_mode,
114	.s_audio_sampling_freq = cx18_s_audio_sampling_freq,
115	.s_video_encoding = cx18_s_video_encoding,
116	.s_stream_vbi_fmt = cx18_s_stream_vbi_fmt,
117};