drivers/media/video/ivtv/ivtv-controls.c

   1 /*
   2     ioctl control functions
   3     Copyright (C) 2003-2004  Kevin Thayer <nufan_wfk at yahoo.com>
   4     Copyright (C) 2005-2007  Hans Verkuil <hverkuil@xs4all.nl>
   5
   6     This program is free software; you can redistribute it and/or modify
   7     it under the terms of the GNU General Public License as published by
   8     the Free Software Foundation; either version 2 of the License, or
   9     (at your option) any later version.
  10
  11     This program is distributed in the hope that it will be useful,
  12     but WITHOUT ANY WARRANTY; without even the implied warranty of
  13     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14     GNU General Public License for more details.
  15
  16     You should have received a copy of the GNU General Public License
  17     along with this program; if not, write to the Free Software
  18     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  19  */
  20
  21 #include "ivtv-driver.h"
  22 #include "ivtv-cards.h"
  23 #include "ivtv-ioctl.h"
  24 #include "ivtv-routing.h"
  25 #include "ivtv-i2c.h"
  26 #include "ivtv-mailbox.h"
  27 #include "ivtv-controls.h"
  28
  29 static const u32 user_ctrls[] = {
  30         V4L2_CID_USER_CLASS,
  31         V4L2_CID_BRIGHTNESS,
  32         V4L2_CID_CONTRAST,
  33         V4L2_CID_SATURATION,
  34         V4L2_CID_HUE,
  35         V4L2_CID_AUDIO_VOLUME,
  36         V4L2_CID_AUDIO_BALANCE,
  37         V4L2_CID_AUDIO_BASS,
  38         V4L2_CID_AUDIO_TREBLE,
  39         V4L2_CID_AUDIO_MUTE,
  40         V4L2_CID_AUDIO_LOUDNESS,
  41         0
  42 };
  43
  44 static const u32 *ctrl_classes[] = {
  45         user_ctrls,
  46         cx2341x_mpeg_ctrls,
  47         NULL
  48 };
  49
  50
  51 int ivtv_queryctrl(struct file *file, void *fh, struct v4l2_queryctrl *qctrl)
  52 {
  53         struct ivtv *itv = ((struct ivtv_open_id *)fh)->itv;
  54         const char *name;
  55
  56         qctrl->id = v4l2_ctrl_next(ctrl_classes, qctrl->id);
  57         if (qctrl->id == 0)
  58                 return -EINVAL;
  59
  60         switch (qctrl->id) {
  61         /* Standard V4L2 controls */
  62         case V4L2_CID_BRIGHTNESS:
  63         case V4L2_CID_HUE:
  64         case V4L2_CID_SATURATION:
  65         case V4L2_CID_CONTRAST:
  66                 if (itv->video_dec_func(itv, VIDIOC_QUERYCTRL, qctrl))
  67                         qctrl->flags |= V4L2_CTRL_FLAG_DISABLED;
  68                 return 0;
  69
  70         case V4L2_CID_AUDIO_VOLUME:
  71         case V4L2_CID_AUDIO_MUTE:
  72         case V4L2_CID_AUDIO_BALANCE:
  73         case V4L2_CID_AUDIO_BASS:
  74         case V4L2_CID_AUDIO_TREBLE:
  75         case V4L2_CID_AUDIO_LOUDNESS:
  76                 if (ivtv_i2c_hw(itv, itv->card->hw_audio_ctrl, VIDIOC_QUERYCTRL, qctrl))
  77                         qctrl->flags |= V4L2_CTRL_FLAG_DISABLED;
  78                 return 0;
  79
  80         default:
  81                 if (cx2341x_ctrl_query(&itv->params, qctrl))
  82                         qctrl->flags |= V4L2_CTRL_FLAG_DISABLED;
  83                 return 0;
  84         }
  85         strncpy(qctrl->name, name, sizeof(qctrl->name) - 1);
  86         qctrl->name[sizeof(qctrl->name) - 1] = 0;
  87         return 0;
  88 }
  89
  90 int ivtv_querymenu(struct file *file, void *fh, struct v4l2_querymenu *qmenu)
  91 {
  92         struct ivtv *itv = ((struct ivtv_open_id *)fh)->itv;
  93         struct v4l2_queryctrl qctrl;
  94
  95         qctrl.id = qmenu->id;
  96         ivtv_queryctrl(file, fh, &qctrl);
  97         return v4l2_ctrl_query_menu(qmenu, &qctrl,
  98                         cx2341x_ctrl_get_menu(&itv->params, qmenu->id));
  99 }
 100
 101 static int ivtv_try_ctrl(struct file *file, void *fh,
 102                                         struct v4l2_ext_control *vctrl)
 103 {
 104         struct v4l2_queryctrl qctrl;
 105         const char **menu_items = NULL;
 106         int err;
 107
 108         qctrl.id = vctrl->id;
 109         err = ivtv_queryctrl(file, fh, &qctrl);
 110         if (err)
 111                 return err;
 112         if (qctrl.type == V4L2_CTRL_TYPE_MENU)
 113                 menu_items = v4l2_ctrl_get_menu(qctrl.id);
 114         return v4l2_ctrl_check(vctrl, &qctrl, menu_items);
 115 }
 116
 117 static int ivtv_s_ctrl(struct ivtv *itv, struct v4l2_control *vctrl)
 118 {
 119         switch (vctrl->id) {
 120                 /* Standard V4L2 controls */
 121         case V4L2_CID_BRIGHTNESS:
 122         case V4L2_CID_HUE:
 123         case V4L2_CID_SATURATION:
 124         case V4L2_CID_CONTRAST:
 125                 return itv->video_dec_func(itv, VIDIOC_S_CTRL, vctrl);
 126
 127         case V4L2_CID_AUDIO_VOLUME:
 128         case V4L2_CID_AUDIO_MUTE:
 129         case V4L2_CID_AUDIO_BALANCE:
 130         case V4L2_CID_AUDIO_BASS:
 131         case V4L2_CID_AUDIO_TREBLE:
 132         case V4L2_CID_AUDIO_LOUDNESS:
 133                 return ivtv_i2c_hw(itv, itv->card->hw_audio_ctrl, VIDIOC_S_CTRL, vctrl);
 134
 135         default:
 136                 IVTV_DEBUG_IOCTL("invalid control 0x%x\n", vctrl->id);
 137                 return -EINVAL;
 138         }
 139         return 0;
 140 }
 141
 142 static int ivtv_g_ctrl(struct ivtv *itv, struct v4l2_control *vctrl)
 143 {
 144         switch (vctrl->id) {
 145                 /* Standard V4L2 controls */
 146         case V4L2_CID_BRIGHTNESS:
 147         case V4L2_CID_HUE:
 148         case V4L2_CID_SATURATION:
 149         case V4L2_CID_CONTRAST:
 150                 return itv->video_dec_func(itv, VIDIOC_G_CTRL, vctrl);
 151
 152         case V4L2_CID_AUDIO_VOLUME:
 153         case V4L2_CID_AUDIO_MUTE:
 154         case V4L2_CID_AUDIO_BALANCE:
 155         case V4L2_CID_AUDIO_BASS:
 156         case V4L2_CID_AUDIO_TREBLE:
 157         case V4L2_CID_AUDIO_LOUDNESS:
 158                 return ivtv_i2c_hw(itv, itv->card->hw_audio_ctrl, VIDIOC_G_CTRL, vctrl);
 159         default:
 160                 IVTV_DEBUG_IOCTL("invalid control 0x%x\n", vctrl->id);
 161                 return -EINVAL;
 162         }
 163         return 0;
 164 }
 165
 166 static int ivtv_setup_vbi_fmt(struct ivtv *itv, enum v4l2_mpeg_stream_vbi_fmt fmt)
 167 {
 168         if (!(itv->v4l2_cap & V4L2_CAP_SLICED_VBI_CAPTURE))
 169                 return -EINVAL;
 170         if (atomic_read(&itv->capturing) > 0)
 171                 return -EBUSY;
 172
 173         /* First try to allocate sliced VBI buffers if needed. */
 174         if (fmt && itv->vbi.sliced_mpeg_data[0] == NULL) {
 175                 int i;
 176
 177                 for (i = 0; i < IVTV_VBI_FRAMES; i++) {
 178                         /* Yuck, hardcoded. Needs to be a define */
 179                         itv->vbi.sliced_mpeg_data[i] = kmalloc(2049, GFP_KERNEL);
 180                         if (itv->vbi.sliced_mpeg_data[i] == NULL) {
 181                                 while (--i >= 0) {
 182                                         kfree(itv->vbi.sliced_mpeg_data[i]);
 183                                         itv->vbi.sliced_mpeg_data[i] = NULL;
 184                                 }
 185                                 return -ENOMEM;
 186                         }
 187                 }
 188         }
 189
 190         itv->vbi.insert_mpeg = fmt;
 191
 192         if (itv->vbi.insert_mpeg == 0) {
 193                 return 0;
 194         }
 195         /* Need sliced data for mpeg insertion */
 196         if (ivtv_get_service_set(itv->vbi.sliced_in) == 0) {
 197                 if (itv->is_60hz)
 198                         itv->vbi.sliced_in->service_set = V4L2_SLICED_CAPTION_525;
 199                 else
 200                         itv->vbi.sliced_in->service_set = V4L2_SLICED_WSS_625;
 201                 ivtv_expand_service_set(itv->vbi.sliced_in, itv->is_50hz);
 202         }
 203         return 0;
 204 }
 205
 206 int ivtv_g_ext_ctrls(struct file *file, void *fh, struct v4l2_ext_controls *c)
 207 {
 208         struct ivtv *itv = ((struct ivtv_open_id *)fh)->itv;
 209         struct v4l2_control ctrl;
 210
 211         if (c->ctrl_class == V4L2_CTRL_CLASS_USER) {
 212                 int i;
 213                 int err = 0;
 214
 215                 for (i = 0; i < c->count; i++) {
 216                         ctrl.id = c->controls[i].id;
 217                         ctrl.value = c->controls[i].value;
 218                         err = ivtv_g_ctrl(itv, &ctrl);
 219                         c->controls[i].value = ctrl.value;
 220                         if (err) {
 221                                 c->error_idx = i;
 222                                 break;
 223                         }
 224                 }
 225                 return err;
 226         }
 227         if (c->ctrl_class == V4L2_CTRL_CLASS_MPEG)
 228                 return cx2341x_ext_ctrls(&itv->params, 0, c, VIDIOC_G_EXT_CTRLS);
 229         return -EINVAL;
 230 }
 231
 232 int ivtv_s_ext_ctrls(struct file *file, void *fh, struct v4l2_ext_controls *c)
 233 {
 234         struct ivtv *itv = ((struct ivtv_open_id *)fh)->itv;
 235         struct v4l2_control ctrl;
 236
 237         if (c->ctrl_class == V4L2_CTRL_CLASS_USER) {
 238                 int i;
 239                 int err = 0;
 240
 241                 for (i = 0; i < c->count; i++) {
 242                         ctrl.id = c->controls[i].id;
 243                         ctrl.value = c->controls[i].value;
 244                         err = ivtv_s_ctrl(itv, &ctrl);
 245                         c->controls[i].value = ctrl.value;
 246                         if (err) {
 247                                 c->error_idx = i;
 248                                 break;
 249                         }
 250                 }
 251                 return err;
 252         }
 253         if (c->ctrl_class == V4L2_CTRL_CLASS_MPEG) {
 254                 static u32 freqs[3] = { 44100, 48000, 32000 };
 255                 struct cx2341x_mpeg_params p = itv->params;
 256                 int err = cx2341x_ext_ctrls(&p, atomic_read(&itv->capturing), c, VIDIOC_S_EXT_CTRLS);
 257                 unsigned idx;
 258
 259                 if (err)
 260                         return err;
 261
 262                 if (p.video_encoding != itv->params.video_encoding) {
 263                         int is_mpeg1 = p.video_encoding ==
 264                                 V4L2_MPEG_VIDEO_ENCODING_MPEG_1;
 265                         struct v4l2_format fmt;
 266
 267                         /* fix videodecoder resolution */
 268                         fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 269                         fmt.fmt.pix.width = itv->params.width / (is_mpeg1 ? 2 : 1);
 270                         fmt.fmt.pix.height = itv->params.height;
 271                         itv->video_dec_func(itv, VIDIOC_S_FMT, &fmt);
 272                 }
 273                 err = cx2341x_update(itv, ivtv_api_func, &itv->params, &p);
 274                 if (!err && itv->params.stream_vbi_fmt != p.stream_vbi_fmt)
 275                         err = ivtv_setup_vbi_fmt(itv, p.stream_vbi_fmt);
 276                 itv->params = p;
 277                 itv->dualwatch_stereo_mode = p.audio_properties & 0x0300;
 278                 idx = p.audio_properties & 0x03;
 279                 /* The audio clock of the digitizer must match the codec sample
 280                    rate otherwise you get some very strange effects. */
 281                 if (idx < sizeof(freqs))
 282                         ivtv_call_i2c_clients(itv, VIDIOC_INT_AUDIO_CLOCK_FREQ, &freqs[idx]);
 283                 return err;
 284         }
 285         return -EINVAL;
 286 }
 287
 288 int ivtv_try_ext_ctrls(struct file *file, void *fh, struct v4l2_ext_controls *c)
 289 {
 290         struct ivtv *itv = ((struct ivtv_open_id *)fh)->itv;
 291
 292         if (c->ctrl_class == V4L2_CTRL_CLASS_USER) {
 293                 int i;
 294                 int err = 0;
 295
 296                 for (i = 0; i < c->count; i++) {
 297                         err = ivtv_try_ctrl(file, fh, &c->controls[i]);
 298                         if (err) {
 299                                 c->error_idx = i;
 300                                 break;
 301                         }
 302                 }
 303                 return err;
 304         }
 305         if (c->ctrl_class == V4L2_CTRL_CLASS_MPEG)
 306                 return cx2341x_ext_ctrls(&itv->params, atomic_read(&itv->capturing), c, VIDIOC_TRY_EXT_CTRLS);
 307         return -EINVAL;
 308 }