release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/media/video/cx18/cx18-controls.c

   1 /*
   2  *  cx18 ioctl control functions
   3  *
   4  *  Derived from ivtv-controls.c
   5  *
   6  *  Copyright (C) 2007  Hans Verkuil <hverkuil@xs4all.nl>
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License as published by
  10  *  the Free Software Foundation; either version 2 of the License, or
  11  *  (at your option) any later version.
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; if not, write to the Free Software
  20  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
  21  *  02111-1307  USA
  22  */
  23 #include <linux/kernel.h>
  24 #include <linux/slab.h>
  25
  26 #include "cx18-driver.h"
  27 #include "cx18-cards.h"
  28 #include "cx18-ioctl.h"
  29 #include "cx18-audio.h"
  30 #include "cx18-mailbox.h"
  31 #include "cx18-controls.h"
  32
  33 /* Must be sorted from low to high control ID! */
  34 static const u32 user_ctrls[] = {
  35         V4L2_CID_USER_CLASS,
  36         V4L2_CID_BRIGHTNESS,
  37         V4L2_CID_CONTRAST,
  38         V4L2_CID_SATURATION,
  39         V4L2_CID_HUE,
  40         V4L2_CID_AUDIO_VOLUME,
  41         V4L2_CID_AUDIO_BALANCE,
  42         V4L2_CID_AUDIO_BASS,
  43         V4L2_CID_AUDIO_TREBLE,
  44         V4L2_CID_AUDIO_MUTE,
  45         V4L2_CID_AUDIO_LOUDNESS,
  46         0
  47 };
  48
  49 static const u32 *ctrl_classes[] = {
  50         user_ctrls,
  51         cx2341x_mpeg_ctrls,
  52         NULL
  53 };
  54
  55 int cx18_queryctrl(struct file *file, void *fh, struct v4l2_queryctrl *qctrl)
  56 {
  57         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
  58         const char *name;
  59
  60         qctrl->id = v4l2_ctrl_next(ctrl_classes, qctrl->id);
  61         if (qctrl->id == 0)
  62                 return -EINVAL;
  63
  64         switch (qctrl->id) {
  65         /* Standard V4L2 controls */
  66         case V4L2_CID_USER_CLASS:
  67                 return v4l2_ctrl_query_fill(qctrl, 0, 0, 0, 0);
  68         case V4L2_CID_BRIGHTNESS:
  69         case V4L2_CID_HUE:
  70         case V4L2_CID_SATURATION:
  71         case V4L2_CID_CONTRAST:
  72                 if (v4l2_subdev_call(cx->sd_av, core, queryctrl, qctrl))
  73                         qctrl->flags |= V4L2_CTRL_FLAG_DISABLED;
  74                 return 0;
  75
  76         case V4L2_CID_AUDIO_VOLUME:
  77         case V4L2_CID_AUDIO_MUTE:
  78         case V4L2_CID_AUDIO_BALANCE:
  79         case V4L2_CID_AUDIO_BASS:
  80         case V4L2_CID_AUDIO_TREBLE:
  81         case V4L2_CID_AUDIO_LOUDNESS:
  82                 if (v4l2_subdev_call(cx->sd_av, core, queryctrl, qctrl))
  83                         qctrl->flags |= V4L2_CTRL_FLAG_DISABLED;
  84                 return 0;
  85
  86         default:
  87                 if (cx2341x_ctrl_query(&cx->params, qctrl))
  88                         qctrl->flags |= V4L2_CTRL_FLAG_DISABLED;
  89                 return 0;
  90         }
  91         strncpy(qctrl->name, name, sizeof(qctrl->name) - 1);
  92         qctrl->name[sizeof(qctrl->name) - 1] = 0;
  93         return 0;
  94 }
  95
  96 int cx18_querymenu(struct file *file, void *fh, struct v4l2_querymenu *qmenu)
  97 {
  98         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
  99         struct v4l2_queryctrl qctrl;
 100
 101         qctrl.id = qmenu->id;
 102         cx18_queryctrl(file, fh, &qctrl);
 103         return v4l2_ctrl_query_menu(qmenu, &qctrl,
 104                         cx2341x_ctrl_get_menu(&cx->params, qmenu->id));
 105 }
 106
 107 static int cx18_try_ctrl(struct file *file, void *fh,
 108                                         struct v4l2_ext_control *vctrl)
 109 {
 110         struct v4l2_queryctrl qctrl;
 111         const char **menu_items = NULL;
 112         int err;
 113
 114         qctrl.id = vctrl->id;
 115         err = cx18_queryctrl(file, fh, &qctrl);
 116         if (err)
 117                 return err;
 118         if (qctrl.type == V4L2_CTRL_TYPE_MENU)
 119                 menu_items = v4l2_ctrl_get_menu(qctrl.id);
 120         return v4l2_ctrl_check(vctrl, &qctrl, menu_items);
 121 }
 122
 123 static int cx18_s_ctrl(struct cx18 *cx, struct v4l2_control *vctrl)
 124 {
 125         switch (vctrl->id) {
 126                 /* Standard V4L2 controls */
 127         case V4L2_CID_BRIGHTNESS:
 128         case V4L2_CID_HUE:
 129         case V4L2_CID_SATURATION:
 130         case V4L2_CID_CONTRAST:
 131                 return v4l2_subdev_call(cx->sd_av, core, s_ctrl, vctrl);
 132
 133         case V4L2_CID_AUDIO_VOLUME:
 134         case V4L2_CID_AUDIO_MUTE:
 135         case V4L2_CID_AUDIO_BALANCE:
 136         case V4L2_CID_AUDIO_BASS:
 137         case V4L2_CID_AUDIO_TREBLE:
 138         case V4L2_CID_AUDIO_LOUDNESS:
 139                 return v4l2_subdev_call(cx->sd_av, core, s_ctrl, vctrl);
 140
 141         default:
 142                 CX18_DEBUG_IOCTL("invalid control 0x%x\n", vctrl->id);
 143                 return -EINVAL;
 144         }
 145         return 0;
 146 }
 147
 148 static int cx18_g_ctrl(struct cx18 *cx, struct v4l2_control *vctrl)
 149 {
 150         switch (vctrl->id) {
 151                 /* Standard V4L2 controls */
 152         case V4L2_CID_BRIGHTNESS:
 153         case V4L2_CID_HUE:
 154         case V4L2_CID_SATURATION:
 155         case V4L2_CID_CONTRAST:
 156                 return v4l2_subdev_call(cx->sd_av, core, g_ctrl, vctrl);
 157
 158         case V4L2_CID_AUDIO_VOLUME:
 159         case V4L2_CID_AUDIO_MUTE:
 160         case V4L2_CID_AUDIO_BALANCE:
 161         case V4L2_CID_AUDIO_BASS:
 162         case V4L2_CID_AUDIO_TREBLE:
 163         case V4L2_CID_AUDIO_LOUDNESS:
 164                 return v4l2_subdev_call(cx->sd_av, core, g_ctrl, vctrl);
 165
 166         default:
 167                 CX18_DEBUG_IOCTL("invalid control 0x%x\n", vctrl->id);
 168                 return -EINVAL;
 169         }
 170         return 0;
 171 }
 172
 173 static int cx18_setup_vbi_fmt(struct cx18 *cx,
 174                               enum v4l2_mpeg_stream_vbi_fmt fmt,
 175                               enum v4l2_mpeg_stream_type type)
 176 {
 177         if (!(cx->v4l2_cap & V4L2_CAP_SLICED_VBI_CAPTURE))
 178                 return -EINVAL;
 179         if (atomic_read(&cx->ana_capturing) > 0)
 180                 return -EBUSY;
 181
 182         if (fmt != V4L2_MPEG_STREAM_VBI_FMT_IVTV ||
 183             !(type == V4L2_MPEG_STREAM_TYPE_MPEG2_PS ||
 184               type == V4L2_MPEG_STREAM_TYPE_MPEG2_DVD ||
 185               type == V4L2_MPEG_STREAM_TYPE_MPEG2_SVCD)) {
 186                 /* Only IVTV fmt VBI insertion & only MPEG-2 PS type streams */
 187                 cx->vbi.insert_mpeg = V4L2_MPEG_STREAM_VBI_FMT_NONE;
 188                 CX18_DEBUG_INFO("disabled insertion of sliced VBI data into "
 189                                 "the MPEG stream\n");
 190                 return 0;
 191         }
 192
 193         /* Allocate sliced VBI buffers if needed. */
 194         if (cx->vbi.sliced_mpeg_data[0] == NULL) {
 195                 int i;
 196
 197                 for (i = 0; i < CX18_VBI_FRAMES; i++) {
 198                         cx->vbi.sliced_mpeg_data[i] =
 199                                kmalloc(CX18_SLICED_MPEG_DATA_BUFSZ, GFP_KERNEL);
 200                         if (cx->vbi.sliced_mpeg_data[i] == NULL) {
 201                                 while (--i >= 0) {
 202                                         kfree(cx->vbi.sliced_mpeg_data[i]);
 203                                         cx->vbi.sliced_mpeg_data[i] = NULL;
 204                                 }
 205                                 cx->vbi.insert_mpeg =
 206                                                   V4L2_MPEG_STREAM_VBI_FMT_NONE;
 207                                 CX18_WARN("Unable to allocate buffers for "
 208                                           "sliced VBI data insertion\n");
 209                                 return -ENOMEM;
 210                         }
 211                 }
 212         }
 213
 214         cx->vbi.insert_mpeg = fmt;
 215         CX18_DEBUG_INFO("enabled insertion of sliced VBI data into the MPEG PS,"
 216                         "when sliced VBI is enabled\n");
 217
 218         /*
 219          * If our current settings have no lines set for capture, store a valid,
 220          * default set of service lines to capture, in our current settings.
 221          */
 222         if (cx18_get_service_set(cx->vbi.sliced_in) == 0) {
 223                 if (cx->is_60hz)
 224                         cx->vbi.sliced_in->service_set =
 225                                                         V4L2_SLICED_CAPTION_525;
 226                 else
 227                         cx->vbi.sliced_in->service_set = V4L2_SLICED_WSS_625;
 228                 cx18_expand_service_set(cx->vbi.sliced_in, cx->is_50hz);
 229         }
 230         return 0;
 231 }
 232
 233 int cx18_g_ext_ctrls(struct file *file, void *fh, struct v4l2_ext_controls *c)
 234 {
 235         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
 236         struct v4l2_control ctrl;
 237
 238         if (c->ctrl_class == V4L2_CTRL_CLASS_USER) {
 239                 int i;
 240                 int err = 0;
 241
 242                 for (i = 0; i < c->count; i++) {
 243                         ctrl.id = c->controls[i].id;
 244                         ctrl.value = c->controls[i].value;
 245                         err = cx18_g_ctrl(cx, &ctrl);
 246                         c->controls[i].value = ctrl.value;
 247                         if (err) {
 248                                 c->error_idx = i;
 249                                 break;
 250                         }
 251                 }
 252                 return err;
 253         }
 254         if (c->ctrl_class == V4L2_CTRL_CLASS_MPEG)
 255                 return cx2341x_ext_ctrls(&cx->params, 0, c, VIDIOC_G_EXT_CTRLS);
 256         return -EINVAL;
 257 }
 258
 259 int cx18_s_ext_ctrls(struct file *file, void *fh, struct v4l2_ext_controls *c)
 260 {
 261         struct cx18_open_id *id = fh;
 262         struct cx18 *cx = id->cx;
 263         int ret;
 264         struct v4l2_control ctrl;
 265
 266         ret = v4l2_prio_check(&cx->prio, id->prio);
 267         if (ret)
 268                 return ret;
 269
 270         if (c->ctrl_class == V4L2_CTRL_CLASS_USER) {
 271                 int i;
 272                 int err = 0;
 273
 274                 for (i = 0; i < c->count; i++) {
 275                         ctrl.id = c->controls[i].id;
 276                         ctrl.value = c->controls[i].value;
 277                         err = cx18_s_ctrl(cx, &ctrl);
 278                         c->controls[i].value = ctrl.value;
 279                         if (err) {
 280                                 c->error_idx = i;
 281                                 break;
 282                         }
 283                 }
 284                 return err;
 285         }
 286         if (c->ctrl_class == V4L2_CTRL_CLASS_MPEG) {
 287                 static u32 freqs[3] = { 44100, 48000, 32000 };
 288                 struct cx18_api_func_private priv;
 289                 struct cx2341x_mpeg_params p = cx->params;
 290                 int err = cx2341x_ext_ctrls(&p, atomic_read(&cx->ana_capturing),
 291                                                 c, VIDIOC_S_EXT_CTRLS);
 292                 unsigned int idx;
 293
 294                 if (err)
 295                         return err;
 296
 297                 if (p.video_encoding != cx->params.video_encoding) {
 298                         int is_mpeg1 = p.video_encoding ==
 299                                                 V4L2_MPEG_VIDEO_ENCODING_MPEG_1;
 300                         struct v4l2_mbus_framefmt fmt;
 301
 302                         /* fix videodecoder resolution */
 303                         fmt.width = cx->params.width / (is_mpeg1 ? 2 : 1);
 304                         fmt.height = cx->params.height;
 305                         fmt.code = V4L2_MBUS_FMT_FIXED;
 306                         v4l2_subdev_call(cx->sd_av, video, s_mbus_fmt, &fmt);
 307                 }
 308                 priv.cx = cx;
 309                 priv.s = &cx->streams[id->type];
 310                 err = cx2341x_update(&priv, cx18_api_func, &cx->params, &p);
 311                 if (!err &&
 312                     (cx->params.stream_vbi_fmt != p.stream_vbi_fmt ||
 313                      cx->params.stream_type != p.stream_type))
 314                         err = cx18_setup_vbi_fmt(cx, p.stream_vbi_fmt,
 315                                                  p.stream_type);
 316                 cx->params = p;
 317                 cx->dualwatch_stereo_mode = p.audio_properties & 0x0300;
 318                 idx = p.audio_properties & 0x03;
 319                 /* The audio clock of the digitizer must match the codec sample
 320                    rate otherwise you get some very strange effects. */
 321                 if (idx < ARRAY_SIZE(freqs))
 322                         cx18_call_all(cx, audio, s_clock_freq, freqs[idx]);
 323                 return err;
 324         }
 325         return -EINVAL;
 326 }
 327
 328 int cx18_try_ext_ctrls(struct file *file, void *fh, struct v4l2_ext_controls *c)
 329 {
 330         struct cx18 *cx = ((struct cx18_open_id *)fh)->cx;
 331
 332         if (c->ctrl_class == V4L2_CTRL_CLASS_USER) {
 333                 int i;
 334                 int err = 0;
 335
 336                 for (i = 0; i < c->count; i++) {
 337                         err = cx18_try_ctrl(file, fh, &c->controls[i]);
 338                         if (err) {
 339                                 c->error_idx = i;
 340                                 break;
 341                         }
 342                 }
 343                 return err;
 344         }
 345         if (c->ctrl_class == V4L2_CTRL_CLASS_MPEG)
 346                 return cx2341x_ext_ctrls(&cx->params,
 347                                                 atomic_read(&cx->ana_capturing),
 348                                                 c, VIDIOC_TRY_EXT_CTRLS);
 349         return -EINVAL;
 350 }