drivers/media/pci/cx18/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@xs4all.nl>
   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
  19 static 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
  75 static 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
  92 static 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
 104 static 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
 112 const 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 };