Merge branch 'master' of /home/davem/src/GIT/linux-2.6/
[linux-2.6] / 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 (v4l2_subdev_call(itv->sd_video, core, 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 (v4l2_subdev_call(itv->sd_audio, core, 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 v4l2_subdev_call(itv->sd_video, core, 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 v4l2_subdev_call(itv->sd_audio, core, 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 v4l2_subdev_call(itv->sd_video, core, 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 v4l2_subdev_call(itv->sd_audio, core, 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                         v4l2_subdev_call(itv->sd_video, video, 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_all(itv, audio, s_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 }