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
ivtv_queryctrl(struct file * file,void * fh,struct v4l2_queryctrl * qctrl)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
ivtv_querymenu(struct file * file,void * fh,struct v4l2_querymenu * qmenu)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
ivtv_try_ctrl(struct file * file,void * fh,struct v4l2_ext_control * vctrl)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
ivtv_s_ctrl(struct ivtv * itv,struct v4l2_control * vctrl)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
ivtv_g_ctrl(struct ivtv * itv,struct v4l2_control * vctrl)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
ivtv_setup_vbi_fmt(struct ivtv * itv,enum v4l2_mpeg_stream_vbi_fmt fmt)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
ivtv_g_ext_ctrls(struct file * file,void * fh,struct v4l2_ext_controls * c)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
ivtv_s_ext_ctrls(struct file * file,void * fh,struct v4l2_ext_controls * c)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
ivtv_try_ext_ctrls(struct file * file,void * fh,struct v4l2_ext_controls * c)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 }
309