1 /* GStreamer
2 *
3 * Copyright (C) 2002 Ronald Bultje <rbultje@ronald.bitfreak.net>
4 * 2006 Edgard Lima <edgard.lima@gmail.com>
5 *
6 * v4l2_calls.c - generic V4L2 calls handling
7 *
8 * This library is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU Library General Public
10 * License as published by the Free Software Foundation; either
11 * version 2 of the License, or (at your option) any later version.
12 *
13 * This library 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 GNU
16 * Library General Public License for more details.
17 *
18 * You should have received a copy of the GNU Library General Public
19 * License along with this library; if not, write to the
20 * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor,
21 * Boston, MA 02110-1301, USA.
22 */
23
24 #ifdef HAVE_CONFIG_H
25 #include <config.h>
26 #endif
27
28 #include <sys/types.h>
29 #include <sys/stat.h>
30 #include <fcntl.h>
31 #include <sys/ioctl.h>
32 #include <sys/mman.h>
33 #include <string.h>
34 #include <errno.h>
35 #include <unistd.h>
36 #ifdef __sun
37 /* Needed on older Solaris Nevada builds (72 at least) */
38 #include <stropts.h>
39 #include <sys/ioccom.h>
40 #endif
41 #include "gstv4l2object.h"
42 #include "gstv4l2tuner.h"
43 #include "gstv4l2colorbalance.h"
44
45 #include "gstv4l2src.h"
46 #include "gstv4l2sink.h"
47 #include "gstv4l2videodec.h"
48
49 #include "gst/gst-i18n-plugin.h"
50
51 GST_DEBUG_CATEGORY_EXTERN (v4l2_debug);
52 #define GST_CAT_DEFAULT v4l2_debug
53
54 /******************************************************
55 * gst_v4l2_get_capabilities():
56 * get the device's capturing capabilities
57 * return value: TRUE on success, FALSE on error
58 ******************************************************/
59 static gboolean
gst_v4l2_get_capabilities(GstV4l2Object * v4l2object)60 gst_v4l2_get_capabilities (GstV4l2Object * v4l2object)
61 {
62 GstElement *e;
63
64 e = v4l2object->element;
65
66 GST_DEBUG_OBJECT (e, "getting capabilities");
67
68 if (!GST_V4L2_IS_OPEN (v4l2object))
69 return FALSE;
70
71 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_QUERYCAP,
72 &v4l2object->vcap) < 0)
73 goto cap_failed;
74
75 if (v4l2object->vcap.capabilities & V4L2_CAP_DEVICE_CAPS)
76 v4l2object->device_caps = v4l2object->vcap.device_caps;
77 else
78 v4l2object->device_caps = v4l2object->vcap.capabilities;
79
80 GST_LOG_OBJECT (e, "driver: '%s'", v4l2object->vcap.driver);
81 GST_LOG_OBJECT (e, "card: '%s'", v4l2object->vcap.card);
82 GST_LOG_OBJECT (e, "bus_info: '%s'", v4l2object->vcap.bus_info);
83 GST_LOG_OBJECT (e, "version: %08x", v4l2object->vcap.version);
84 GST_LOG_OBJECT (e, "capabilites: %08x", v4l2object->device_caps);
85
86 return TRUE;
87
88 /* ERRORS */
89 cap_failed:
90 {
91 GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, SETTINGS,
92 (_("Error getting capabilities for device '%s': "
93 "It isn't a v4l2 driver. Check if it is a v4l1 driver."),
94 v4l2object->videodev), GST_ERROR_SYSTEM);
95 return FALSE;
96 }
97 }
98
99 /******************************************************
100 * The video4linux command line tool v4l2-ctrl
101 * normalises the names of the controls received from
102 * the kernel like:
103 *
104 * "Exposure (absolute)" -> "exposure_absolute"
105 *
106 * We follow their lead here. @name is modified
107 * in-place.
108 ******************************************************/
109 static void
gst_v4l2_normalise_control_name(gchar * name)110 gst_v4l2_normalise_control_name (gchar * name)
111 {
112 int i, j;
113 for (i = 0, j = 0; name[j]; ++j) {
114 if (g_ascii_isalnum (name[j])) {
115 if (i > 0 && !g_ascii_isalnum (name[j - 1]))
116 name[i++] = '_';
117 name[i++] = g_ascii_tolower (name[j]);
118 }
119 }
120 name[i++] = '\0';
121 }
122
123 /******************************************************
124 * gst_v4l2_empty_lists() and gst_v4l2_fill_lists():
125 * fill/empty the lists of enumerations
126 * return value: TRUE on success, FALSE on error
127 ******************************************************/
128 static gboolean
gst_v4l2_fill_lists(GstV4l2Object * v4l2object)129 gst_v4l2_fill_lists (GstV4l2Object * v4l2object)
130 {
131 gint n, next;
132 struct v4l2_queryctrl control = { 0, };
133
134 GstElement *e;
135
136 e = v4l2object->element;
137
138 GST_DEBUG_OBJECT (e, "getting enumerations");
139 GST_V4L2_CHECK_OPEN (v4l2object);
140
141 GST_DEBUG_OBJECT (e, " channels");
142 /* and now, the channels */
143 for (n = 0;; n++) {
144 struct v4l2_input input;
145 GstV4l2TunerChannel *v4l2channel;
146 GstTunerChannel *channel;
147
148 memset (&input, 0, sizeof (input));
149
150 input.index = n;
151 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_ENUMINPUT, &input) < 0) {
152 if (errno == EINVAL || errno == ENOTTY)
153 break; /* end of enumeration */
154 else {
155 GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
156 (_("Failed to query attributes of input %d in device %s"),
157 n, v4l2object->videodev),
158 ("Failed to get %d in input enumeration for %s. (%d - %s)",
159 n, v4l2object->videodev, errno, strerror (errno)));
160 return FALSE;
161 }
162 }
163
164 GST_LOG_OBJECT (e, " index: %d", input.index);
165 GST_LOG_OBJECT (e, " name: '%s'", input.name);
166 GST_LOG_OBJECT (e, " type: %08x", input.type);
167 GST_LOG_OBJECT (e, " audioset: %08x", input.audioset);
168 GST_LOG_OBJECT (e, " std: %016" G_GINT64_MODIFIER "x",
169 (guint64) input.std);
170 GST_LOG_OBJECT (e, " status: %08x", input.status);
171
172 v4l2channel = g_object_new (GST_TYPE_V4L2_TUNER_CHANNEL, NULL);
173 channel = GST_TUNER_CHANNEL (v4l2channel);
174 channel->label = g_strdup ((const gchar *) input.name);
175 channel->flags = GST_TUNER_CHANNEL_INPUT;
176 v4l2channel->index = n;
177
178 if (input.type == V4L2_INPUT_TYPE_TUNER) {
179 struct v4l2_tuner vtun;
180
181 v4l2channel->tuner = input.tuner;
182 channel->flags |= GST_TUNER_CHANNEL_FREQUENCY;
183
184 vtun.index = input.tuner;
185 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_G_TUNER, &vtun) < 0) {
186 GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
187 (_("Failed to get setting of tuner %d on device '%s'."),
188 input.tuner, v4l2object->videodev), GST_ERROR_SYSTEM);
189 g_object_unref (G_OBJECT (channel));
190 return FALSE;
191 }
192
193 channel->freq_multiplicator =
194 62.5 * ((vtun.capability & V4L2_TUNER_CAP_LOW) ? 1 : 1000);
195 channel->min_frequency = vtun.rangelow * channel->freq_multiplicator;
196 channel->max_frequency = vtun.rangehigh * channel->freq_multiplicator;
197 channel->min_signal = 0;
198 channel->max_signal = 0xffff;
199 }
200 if (input.audioset) {
201 /* we take the first. We don't care for
202 * the others for now */
203 while (!(input.audioset & (1 << v4l2channel->audio)))
204 v4l2channel->audio++;
205 channel->flags |= GST_TUNER_CHANNEL_AUDIO;
206 }
207
208 v4l2object->channels =
209 g_list_prepend (v4l2object->channels, (gpointer) channel);
210 }
211 v4l2object->channels = g_list_reverse (v4l2object->channels);
212
213 GST_DEBUG_OBJECT (e, " norms");
214 /* norms... */
215 for (n = 0;; n++) {
216 struct v4l2_standard standard = { 0, };
217 GstV4l2TunerNorm *v4l2norm;
218
219 GstTunerNorm *norm;
220
221 /* fill in defaults */
222 standard.frameperiod.numerator = 1;
223 standard.frameperiod.denominator = 0;
224 standard.index = n;
225
226 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_ENUMSTD, &standard) < 0) {
227 if (errno == EINVAL || errno == ENOTTY)
228 break; /* end of enumeration */
229 #ifdef ENODATA
230 else if (errno == ENODATA)
231 break; /* end of enumeration, as of Linux 3.7-rc1 */
232 #endif
233 else {
234 GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
235 (_("Failed to query norm on device '%s'."),
236 v4l2object->videodev),
237 ("Failed to get attributes for norm %d on devide '%s'. (%d - %s)",
238 n, v4l2object->videodev, errno, strerror (errno)));
239 return FALSE;
240 }
241 }
242
243 GST_DEBUG_OBJECT (e, " '%s', fps: %d / %d",
244 standard.name, standard.frameperiod.denominator,
245 standard.frameperiod.numerator);
246
247 v4l2norm = g_object_new (GST_TYPE_V4L2_TUNER_NORM, NULL);
248 norm = GST_TUNER_NORM (v4l2norm);
249 norm->label = g_strdup ((const gchar *) standard.name);
250 gst_value_set_fraction (&norm->framerate,
251 standard.frameperiod.denominator, standard.frameperiod.numerator);
252 v4l2norm->index = standard.id;
253
254 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "index=%08x, label=%s",
255 (unsigned int) v4l2norm->index, norm->label);
256
257 v4l2object->norms = g_list_prepend (v4l2object->norms, (gpointer) norm);
258 }
259 v4l2object->norms = g_list_reverse (v4l2object->norms);
260
261 GST_DEBUG_OBJECT (e, " controls+menus");
262
263 /* and lastly, controls+menus (if appropriate) */
264 next = V4L2_CTRL_FLAG_NEXT_CTRL;
265 n = 0;
266 control.id = next;
267
268 while (TRUE) {
269 GstV4l2ColorBalanceChannel *v4l2channel;
270 GstColorBalanceChannel *channel;
271
272 if (!next)
273 n++;
274
275 retry:
276 /* when we reached the last official CID, continue with private CIDs */
277 if (n == V4L2_CID_LASTP1) {
278 GST_DEBUG_OBJECT (e, "checking private CIDs");
279 n = V4L2_CID_PRIVATE_BASE;
280 }
281 GST_DEBUG_OBJECT (e, "checking control %08x", n);
282
283 control.id = n | next;
284 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_QUERYCTRL,
285 &control) < 0) {
286 if (next) {
287 if (n > 0) {
288 GST_DEBUG_OBJECT (e, "controls finished");
289 break;
290 } else {
291 GST_DEBUG_OBJECT (e, "V4L2_CTRL_FLAG_NEXT_CTRL not supported.");
292 next = 0;
293 n = V4L2_CID_BASE;
294 goto retry;
295 }
296 }
297 if (errno == EINVAL || errno == ENOTTY || errno == EIO || errno == ENOENT) {
298 if (n < V4L2_CID_PRIVATE_BASE) {
299 GST_DEBUG_OBJECT (e, "skipping control %08x", n);
300 /* continue so that we also check private controls */
301 n = V4L2_CID_PRIVATE_BASE - 1;
302 continue;
303 } else {
304 GST_DEBUG_OBJECT (e, "controls finished");
305 break;
306 }
307 } else {
308 GST_WARNING_OBJECT (e, "Failed querying control %d on device '%s'. "
309 "(%d - %s)", n, v4l2object->videodev, errno, strerror (errno));
310 continue;
311 }
312 }
313 /* bogus driver might mess with id in unexpected ways (e.g. set to 0), so
314 * make sure to simply try all if V4L2_CTRL_FLAG_NEXT_CTRL not supported */
315 if (next)
316 n = control.id;
317 if (control.flags & V4L2_CTRL_FLAG_DISABLED) {
318 GST_DEBUG_OBJECT (e, "skipping disabled control");
319 continue;
320 }
321
322 if (control.type == V4L2_CTRL_TYPE_CTRL_CLASS) {
323 GST_DEBUG_OBJECT (e, "starting control class '%s'", control.name);
324 continue;
325 }
326
327 switch (control.type) {
328 case V4L2_CTRL_TYPE_INTEGER:
329 case V4L2_CTRL_TYPE_BOOLEAN:
330 case V4L2_CTRL_TYPE_MENU:
331 case V4L2_CTRL_TYPE_INTEGER_MENU:
332 case V4L2_CTRL_TYPE_BITMASK:
333 case V4L2_CTRL_TYPE_BUTTON:{
334 control.name[31] = '\0';
335 gst_v4l2_normalise_control_name ((gchar *) control.name);
336 g_datalist_id_set_data (&v4l2object->controls,
337 g_quark_from_string ((const gchar *) control.name),
338 GINT_TO_POINTER (n));
339 break;
340 }
341 default:
342 GST_DEBUG_OBJECT (e,
343 "Control type for '%s' not supported for extra controls.",
344 control.name);
345 break;
346 }
347
348 switch (n) {
349 case V4L2_CID_BRIGHTNESS:
350 case V4L2_CID_CONTRAST:
351 case V4L2_CID_SATURATION:
352 case V4L2_CID_HUE:
353 case V4L2_CID_BLACK_LEVEL:
354 case V4L2_CID_AUTO_WHITE_BALANCE:
355 case V4L2_CID_DO_WHITE_BALANCE:
356 case V4L2_CID_RED_BALANCE:
357 case V4L2_CID_BLUE_BALANCE:
358 case V4L2_CID_GAMMA:
359 case V4L2_CID_EXPOSURE:
360 case V4L2_CID_AUTOGAIN:
361 case V4L2_CID_GAIN:
362 case V4L2_CID_SHARPNESS:
363 /* we only handle these for now (why?) */
364 break;
365 case V4L2_CID_HFLIP:
366 case V4L2_CID_VFLIP:
367 case V4L2_CID_PAN_RESET:
368 case V4L2_CID_TILT_RESET:
369 /* not handled here, handled by VideoOrientation interface */
370 control.id++;
371 break;
372 case V4L2_CID_AUDIO_VOLUME:
373 case V4L2_CID_AUDIO_BALANCE:
374 case V4L2_CID_AUDIO_BASS:
375 case V4L2_CID_AUDIO_TREBLE:
376 case V4L2_CID_AUDIO_MUTE:
377 case V4L2_CID_AUDIO_LOUDNESS:
378 /* FIXME: We should implement GstMixer interface instead */
379 /* but let's not be pedantic and make element more useful for now */
380 break;
381 case V4L2_CID_ALPHA_COMPONENT:
382 v4l2object->has_alpha_component = TRUE;
383 break;
384 default:
385 GST_DEBUG_OBJECT (e,
386 "ControlID %s (%x) unhandled, FIXME", control.name, n);
387 control.id++;
388 break;
389 }
390 if (n != control.id)
391 continue;
392
393 GST_DEBUG_OBJECT (e, "Adding ControlID %s (%x)", control.name, n);
394 v4l2channel = g_object_new (GST_TYPE_V4L2_COLOR_BALANCE_CHANNEL, NULL);
395 channel = GST_COLOR_BALANCE_CHANNEL (v4l2channel);
396 channel->label = g_strdup ((const gchar *) control.name);
397 v4l2channel->id = n;
398
399 #if 0
400 /* FIXME: it will be need just when handling private controls
401 *(currently none of base controls are of this type) */
402 if (control.type == V4L2_CTRL_TYPE_MENU) {
403 struct v4l2_querymenu menu, *mptr;
404
405 int i;
406
407 menu.id = n;
408 for (i = 0;; i++) {
409 menu.index = i;
410 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_QUERYMENU,
411 &menu) < 0) {
412 if (errno == EINVAL)
413 break; /* end of enumeration */
414 else {
415 GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
416 (_("Failed getting controls attributes on device '%s'."),
417 v4l2object->videodev),
418 ("Failed to get %d in menu enumeration for %s. (%d - %s)",
419 n, v4l2object->videodev, errno, strerror (errno)));
420 return FALSE;
421 }
422 }
423 mptr = g_malloc (sizeof (menu));
424 memcpy (mptr, &menu, sizeof (menu));
425 menus = g_list_append (menus, mptr);
426 }
427 }
428 v4l2object->menus = g_list_append (v4l2object->menus, menus);
429 #endif
430
431 switch (control.type) {
432 case V4L2_CTRL_TYPE_INTEGER:
433 channel->min_value = control.minimum;
434 channel->max_value = control.maximum;
435 break;
436 case V4L2_CTRL_TYPE_BOOLEAN:
437 channel->min_value = FALSE;
438 channel->max_value = TRUE;
439 break;
440 default:
441 /* FIXME we should find out how to handle V4L2_CTRL_TYPE_BUTTON.
442 BUTTON controls like V4L2_CID_DO_WHITE_BALANCE can just be set (1) or
443 unset (0), but can't be queried */
444 GST_DEBUG_OBJECT (e,
445 "Control with non supported type %s (%x), type=%d",
446 control.name, n, control.type);
447 channel->min_value = channel->max_value = 0;
448 break;
449 }
450
451 v4l2object->colors =
452 g_list_prepend (v4l2object->colors, (gpointer) channel);
453 }
454 v4l2object->colors = g_list_reverse (v4l2object->colors);
455
456 GST_DEBUG_OBJECT (e, "done");
457 return TRUE;
458 }
459
460
461 static void
gst_v4l2_empty_lists(GstV4l2Object * v4l2object)462 gst_v4l2_empty_lists (GstV4l2Object * v4l2object)
463 {
464 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "deleting enumerations");
465
466 g_list_foreach (v4l2object->channels, (GFunc) g_object_unref, NULL);
467 g_list_free (v4l2object->channels);
468 v4l2object->channels = NULL;
469
470 g_list_foreach (v4l2object->norms, (GFunc) g_object_unref, NULL);
471 g_list_free (v4l2object->norms);
472 v4l2object->norms = NULL;
473
474 g_list_foreach (v4l2object->colors, (GFunc) g_object_unref, NULL);
475 g_list_free (v4l2object->colors);
476 v4l2object->colors = NULL;
477
478 g_datalist_clear (&v4l2object->controls);
479 }
480
481 static void
gst_v4l2_adjust_buf_type(GstV4l2Object * v4l2object)482 gst_v4l2_adjust_buf_type (GstV4l2Object * v4l2object)
483 {
484 /* when calling gst_v4l2_object_new the user decides the initial type
485 * so adjust it if multi-planar is supported
486 * the driver should make it exclusive. So the driver should
487 * not support both MPLANE and non-PLANE.
488 * Because even when using MPLANE it still possibles to use it
489 * in a contiguous manner. In this case the first v4l2 plane
490 * contains all the gst planes.
491 */
492 switch (v4l2object->type) {
493 case V4L2_BUF_TYPE_VIDEO_OUTPUT:
494 if (v4l2object->device_caps &
495 (V4L2_CAP_VIDEO_OUTPUT_MPLANE | V4L2_CAP_VIDEO_M2M_MPLANE)) {
496 GST_DEBUG ("adjust type to multi-planar output");
497 v4l2object->type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
498 }
499 break;
500 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
501 if (v4l2object->device_caps &
502 (V4L2_CAP_VIDEO_CAPTURE_MPLANE | V4L2_CAP_VIDEO_M2M_MPLANE)) {
503 GST_DEBUG ("adjust type to multi-planar capture");
504 v4l2object->type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
505 }
506 break;
507 default:
508 break;
509 }
510 }
511
512 /******************************************************
513 * gst_v4l2_open():
514 * open the video device (v4l2object->videodev)
515 * return value: TRUE on success, FALSE on error
516 ******************************************************/
517 gboolean
gst_v4l2_open(GstV4l2Object * v4l2object)518 gst_v4l2_open (GstV4l2Object * v4l2object)
519 {
520 struct stat st;
521 int libv4l2_fd = -1;
522
523 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "Trying to open device %s",
524 v4l2object->videodev);
525
526 GST_V4L2_CHECK_NOT_OPEN (v4l2object);
527 GST_V4L2_CHECK_NOT_ACTIVE (v4l2object);
528
529 /* be sure we have a device */
530 if (!v4l2object->videodev)
531 v4l2object->videodev = g_strdup ("/dev/video");
532
533 /* check if it is a device */
534 if (stat (v4l2object->videodev, &st) == -1)
535 goto stat_failed;
536
537 if (!S_ISCHR (st.st_mode))
538 goto no_device;
539
540 /* open the device */
541 v4l2object->video_fd =
542 open (v4l2object->videodev, O_RDWR /* | O_NONBLOCK */ );
543
544 if (!GST_V4L2_IS_OPEN (v4l2object))
545 goto not_open;
546
547 #ifdef HAVE_LIBV4L2
548 if (v4l2object->fd_open)
549 libv4l2_fd = v4l2object->fd_open (v4l2object->video_fd,
550 V4L2_ENABLE_ENUM_FMT_EMULATION);
551 #endif
552
553 /* Note the v4l2_xxx functions are designed so that if they get passed an
554 unknown fd, the will behave exactly as their regular xxx counterparts, so
555 if v4l2_fd_open fails, we continue as normal (missing the libv4l2 custom
556 cam format to normal formats conversion). Chances are big we will still
557 fail then though, as normally v4l2_fd_open only fails if the device is not
558 a v4l2 device. */
559 if (libv4l2_fd != -1)
560 v4l2object->video_fd = libv4l2_fd;
561
562 /* get capabilities, error will be posted */
563 if (!gst_v4l2_get_capabilities (v4l2object))
564 goto error;
565
566 /* do we need to be a capture device? */
567 if (GST_IS_V4L2SRC (v4l2object->element) &&
568 !(v4l2object->device_caps & (V4L2_CAP_VIDEO_CAPTURE |
569 V4L2_CAP_VIDEO_CAPTURE_MPLANE)))
570 goto not_capture;
571
572 if (GST_IS_V4L2SINK (v4l2object->element) &&
573 !(v4l2object->device_caps & (V4L2_CAP_VIDEO_OUTPUT |
574 V4L2_CAP_VIDEO_OUTPUT_MPLANE)))
575 goto not_output;
576
577 if (GST_IS_V4L2_VIDEO_DEC (v4l2object->element) &&
578 !GST_V4L2_IS_M2M (v4l2object->device_caps))
579 goto not_m2m;
580
581 gst_v4l2_adjust_buf_type (v4l2object);
582
583 /* create enumerations, posts errors. */
584 if (!gst_v4l2_fill_lists (v4l2object))
585 goto error;
586
587 GST_INFO_OBJECT (v4l2object->dbg_obj,
588 "Opened device '%s' (%s) successfully",
589 v4l2object->vcap.card, v4l2object->videodev);
590
591 if (v4l2object->extra_controls)
592 gst_v4l2_set_controls (v4l2object, v4l2object->extra_controls);
593
594 /* UVC devices are never interlaced, and doing VIDIOC_TRY_FMT on them
595 * causes expensive and slow USB IO, so don't probe them for interlaced
596 */
597 if (!strcmp ((char *) v4l2object->vcap.driver, "uvcusb") ||
598 !strcmp ((char *) v4l2object->vcap.driver, "uvcvideo")) {
599 v4l2object->never_interlaced = TRUE;
600 }
601
602 return TRUE;
603
604 /* ERRORS */
605 stat_failed:
606 {
607 GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
608 (_("Cannot identify device '%s'."), v4l2object->videodev),
609 GST_ERROR_SYSTEM);
610 goto error;
611 }
612 no_device:
613 {
614 GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
615 (_("This isn't a device '%s'."), v4l2object->videodev),
616 GST_ERROR_SYSTEM);
617 goto error;
618 }
619 not_open:
620 {
621 GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, OPEN_READ_WRITE,
622 (_("Could not open device '%s' for reading and writing."),
623 v4l2object->videodev), GST_ERROR_SYSTEM);
624 goto error;
625 }
626 not_capture:
627 {
628 GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
629 (_("Device '%s' is not a capture device."),
630 v4l2object->videodev),
631 ("Capabilities: 0x%x", v4l2object->device_caps));
632 goto error;
633 }
634 not_output:
635 {
636 GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
637 (_("Device '%s' is not a output device."),
638 v4l2object->videodev),
639 ("Capabilities: 0x%x", v4l2object->device_caps));
640 goto error;
641 }
642 not_m2m:
643 {
644 GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
645 (_("Device '%s' is not a M2M device."),
646 v4l2object->videodev),
647 ("Capabilities: 0x%x", v4l2object->device_caps));
648 goto error;
649 }
650 error:
651 {
652 if (GST_V4L2_IS_OPEN (v4l2object)) {
653 /* close device */
654 v4l2object->close (v4l2object->video_fd);
655 v4l2object->video_fd = -1;
656 }
657 /* empty lists */
658 gst_v4l2_empty_lists (v4l2object);
659
660 return FALSE;
661 }
662 }
663
664 gboolean
gst_v4l2_dup(GstV4l2Object * v4l2object,GstV4l2Object * other)665 gst_v4l2_dup (GstV4l2Object * v4l2object, GstV4l2Object * other)
666 {
667 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "Trying to dup device %s",
668 other->videodev);
669
670 GST_V4L2_CHECK_OPEN (other);
671 GST_V4L2_CHECK_NOT_OPEN (v4l2object);
672 GST_V4L2_CHECK_NOT_ACTIVE (other);
673 GST_V4L2_CHECK_NOT_ACTIVE (v4l2object);
674
675 v4l2object->vcap = other->vcap;
676 v4l2object->device_caps = other->device_caps;
677 gst_v4l2_adjust_buf_type (v4l2object);
678
679 v4l2object->video_fd = v4l2object->dup (other->video_fd);
680 if (!GST_V4L2_IS_OPEN (v4l2object))
681 goto not_open;
682
683 g_free (v4l2object->videodev);
684 v4l2object->videodev = g_strdup (other->videodev);
685
686 GST_INFO_OBJECT (v4l2object->dbg_obj,
687 "Cloned device '%s' (%s) successfully",
688 v4l2object->vcap.card, v4l2object->videodev);
689
690 v4l2object->never_interlaced = other->never_interlaced;
691 v4l2object->no_initial_format = other->no_initial_format;
692
693 return TRUE;
694
695 not_open:
696 {
697 GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, OPEN_READ_WRITE,
698 (_("Could not dup device '%s' for reading and writing."),
699 v4l2object->videodev), GST_ERROR_SYSTEM);
700
701 return FALSE;
702 }
703 }
704
705
706 /******************************************************
707 * gst_v4l2_close():
708 * close the video device (v4l2object->video_fd)
709 * return value: TRUE on success, FALSE on error
710 ******************************************************/
711 gboolean
gst_v4l2_close(GstV4l2Object * v4l2object)712 gst_v4l2_close (GstV4l2Object * v4l2object)
713 {
714 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "Trying to close %s",
715 v4l2object->videodev);
716
717 GST_V4L2_CHECK_OPEN (v4l2object);
718 GST_V4L2_CHECK_NOT_ACTIVE (v4l2object);
719
720 /* close device */
721 v4l2object->close (v4l2object->video_fd);
722 v4l2object->video_fd = -1;
723
724 /* empty lists */
725 gst_v4l2_empty_lists (v4l2object);
726
727 return TRUE;
728 }
729
730
731 /******************************************************
732 * gst_v4l2_get_norm()
733 * Get the norm of the current device
734 * return value: TRUE on success, FALSE on error
735 ******************************************************/
736 gboolean
gst_v4l2_get_norm(GstV4l2Object * v4l2object,v4l2_std_id * norm)737 gst_v4l2_get_norm (GstV4l2Object * v4l2object, v4l2_std_id * norm)
738 {
739 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "getting norm");
740
741 if (!GST_V4L2_IS_OPEN (v4l2object))
742 return FALSE;
743
744 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_G_STD, norm) < 0)
745 goto std_failed;
746
747 return TRUE;
748
749 /* ERRORS */
750 std_failed:
751 {
752 GST_DEBUG ("Failed to get the current norm for device %s",
753 v4l2object->videodev);
754 return FALSE;
755 }
756 }
757
758
759 /******************************************************
760 * gst_v4l2_set_norm()
761 * Set the norm of the current device
762 * return value: TRUE on success, FALSE on error
763 ******************************************************/
764 gboolean
gst_v4l2_set_norm(GstV4l2Object * v4l2object,v4l2_std_id norm)765 gst_v4l2_set_norm (GstV4l2Object * v4l2object, v4l2_std_id norm)
766 {
767 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "trying to set norm to "
768 "%" G_GINT64_MODIFIER "x", (guint64) norm);
769
770 if (!GST_V4L2_IS_OPEN (v4l2object))
771 return FALSE;
772
773 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_S_STD, &norm) < 0)
774 goto std_failed;
775
776 return TRUE;
777
778 /* ERRORS */
779 std_failed:
780 {
781 GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
782 (_("Failed to set norm for device '%s'."),
783 v4l2object->videodev), GST_ERROR_SYSTEM);
784 return FALSE;
785 }
786 }
787
788 /******************************************************
789 * gst_v4l2_get_frequency():
790 * get the current frequency
791 * return value: TRUE on success, FALSE on error
792 ******************************************************/
793 gboolean
gst_v4l2_get_frequency(GstV4l2Object * v4l2object,gint tunernum,gulong * frequency)794 gst_v4l2_get_frequency (GstV4l2Object * v4l2object,
795 gint tunernum, gulong * frequency)
796 {
797 struct v4l2_frequency freq = { 0, };
798
799 GstTunerChannel *channel;
800
801 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "getting current tuner frequency");
802
803 if (!GST_V4L2_IS_OPEN (v4l2object))
804 return FALSE;
805
806 channel = gst_tuner_get_channel (GST_TUNER (v4l2object->element));
807
808 freq.tuner = tunernum;
809 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_G_FREQUENCY, &freq) < 0)
810 goto freq_failed;
811
812 *frequency = freq.frequency * channel->freq_multiplicator;
813
814 return TRUE;
815
816 /* ERRORS */
817 freq_failed:
818 {
819 GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
820 (_("Failed to get current tuner frequency for device '%s'."),
821 v4l2object->videodev), GST_ERROR_SYSTEM);
822 return FALSE;
823 }
824 }
825
826
827 /******************************************************
828 * gst_v4l2_set_frequency():
829 * set frequency
830 * return value: TRUE on success, FALSE on error
831 ******************************************************/
832 gboolean
gst_v4l2_set_frequency(GstV4l2Object * v4l2object,gint tunernum,gulong frequency)833 gst_v4l2_set_frequency (GstV4l2Object * v4l2object,
834 gint tunernum, gulong frequency)
835 {
836 struct v4l2_frequency freq = { 0, };
837
838 GstTunerChannel *channel;
839
840 GST_DEBUG_OBJECT (v4l2object->dbg_obj,
841 "setting current tuner frequency to %lu", frequency);
842
843 if (!GST_V4L2_IS_OPEN (v4l2object))
844 return FALSE;
845
846 channel = gst_tuner_get_channel (GST_TUNER (v4l2object->element));
847
848 freq.tuner = tunernum;
849 /* fill in type - ignore error */
850 (void) v4l2object->ioctl (v4l2object->video_fd, VIDIOC_G_FREQUENCY, &freq);
851 freq.frequency = frequency / channel->freq_multiplicator;
852
853 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_S_FREQUENCY, &freq) < 0)
854 goto freq_failed;
855
856 return TRUE;
857
858 /* ERRORS */
859 freq_failed:
860 {
861 GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
862 (_("Failed to set current tuner frequency for device '%s' to %lu Hz."),
863 v4l2object->videodev, frequency), GST_ERROR_SYSTEM);
864 return FALSE;
865 }
866 }
867
868 /******************************************************
869 * gst_v4l2_signal_strength():
870 * get the strength of the signal on the current input
871 * return value: TRUE on success, FALSE on error
872 ******************************************************/
873 gboolean
gst_v4l2_signal_strength(GstV4l2Object * v4l2object,gint tunernum,gulong * signal_strength)874 gst_v4l2_signal_strength (GstV4l2Object * v4l2object,
875 gint tunernum, gulong * signal_strength)
876 {
877 struct v4l2_tuner tuner = { 0, };
878
879 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "trying to get signal strength");
880
881 if (!GST_V4L2_IS_OPEN (v4l2object))
882 return FALSE;
883
884 tuner.index = tunernum;
885 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_G_TUNER, &tuner) < 0)
886 goto tuner_failed;
887
888 *signal_strength = tuner.signal;
889
890 return TRUE;
891
892 /* ERRORS */
893 tuner_failed:
894 {
895 GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
896 (_("Failed to get signal strength for device '%s'."),
897 v4l2object->videodev), GST_ERROR_SYSTEM);
898 return FALSE;
899 }
900 }
901
902 /******************************************************
903 * gst_v4l2_get_attribute():
904 * try to get the value of one specific attribute
905 * return value: TRUE on success, FALSE on error
906 ******************************************************/
907 gboolean
gst_v4l2_get_attribute(GstV4l2Object * v4l2object,int attribute_num,int * value)908 gst_v4l2_get_attribute (GstV4l2Object * v4l2object,
909 int attribute_num, int *value)
910 {
911 struct v4l2_control control = { 0, };
912
913 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "getting value of attribute %d",
914 attribute_num);
915
916 if (!GST_V4L2_IS_OPEN (v4l2object))
917 return FALSE;
918
919 control.id = attribute_num;
920
921 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_G_CTRL, &control) < 0)
922 goto ctrl_failed;
923
924 *value = control.value;
925
926 return TRUE;
927
928 /* ERRORS */
929 ctrl_failed:
930 {
931 GST_WARNING_OBJECT (v4l2object,
932 _("Failed to get value for control %d on device '%s'."),
933 attribute_num, v4l2object->videodev);
934 return FALSE;
935 }
936 }
937
938
939 /******************************************************
940 * gst_v4l2_set_attribute():
941 * try to set the value of one specific attribute
942 * return value: TRUE on success, FALSE on error
943 ******************************************************/
944 gboolean
gst_v4l2_set_attribute(GstV4l2Object * v4l2object,int attribute_num,const int value)945 gst_v4l2_set_attribute (GstV4l2Object * v4l2object,
946 int attribute_num, const int value)
947 {
948 struct v4l2_control control = { 0, };
949
950 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "setting value of attribute %d to %d",
951 attribute_num, value);
952
953 if (!GST_V4L2_IS_OPEN (v4l2object))
954 return FALSE;
955
956 control.id = attribute_num;
957 control.value = value;
958 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_S_CTRL, &control) < 0)
959 goto ctrl_failed;
960
961 return TRUE;
962
963 /* ERRORS */
964 ctrl_failed:
965 {
966 GST_WARNING_OBJECT (v4l2object,
967 _("Failed to set value %d for control %d on device '%s'."),
968 value, attribute_num, v4l2object->videodev);
969 return FALSE;
970 }
971 }
972
973 static gboolean
set_control(GQuark field_id,const GValue * value,gpointer user_data)974 set_control (GQuark field_id, const GValue * value, gpointer user_data)
975 {
976 GstV4l2Object *v4l2object = user_data;
977 GQuark normalised_field_id;
978 gpointer *d;
979
980 /* 32 bytes is the maximum size for a control name according to v4l2 */
981 gchar name[32];
982
983 /* Backwards compatibility: in the past GStreamer would normalise strings in
984 a subtly different way to v4l2-ctl. e.g. the kernel's "Focus (absolute)"
985 would become "focus__absolute_" whereas now it becomes "focus_absolute".
986 Please remove the following in GStreamer 1.5 for 1.6 */
987 strncpy (name, g_quark_to_string (field_id), sizeof (name));
988 name[31] = '\0';
989 gst_v4l2_normalise_control_name (name);
990 normalised_field_id = g_quark_from_string (name);
991 if (normalised_field_id != field_id)
992 g_warning ("In GStreamer 1.4 the way V4L2 control names were normalised "
993 "changed. Instead of setting \"%s\" please use \"%s\". The former is "
994 "deprecated and will be removed in a future version of GStreamer",
995 g_quark_to_string (field_id), name);
996 field_id = normalised_field_id;
997
998 d = g_datalist_id_get_data (&v4l2object->controls, field_id);
999 if (!d) {
1000 GST_WARNING_OBJECT (v4l2object,
1001 "Control '%s' does not exist or has an unsupported type.",
1002 g_quark_to_string (field_id));
1003 return TRUE;
1004 }
1005 if (!G_VALUE_HOLDS (value, G_TYPE_INT)) {
1006 GST_WARNING_OBJECT (v4l2object,
1007 "'int' value expected for control '%s'.", g_quark_to_string (field_id));
1008 return TRUE;
1009 }
1010 gst_v4l2_set_attribute (v4l2object, GPOINTER_TO_INT (d),
1011 g_value_get_int (value));
1012 return TRUE;
1013 }
1014
1015 gboolean
gst_v4l2_set_controls(GstV4l2Object * v4l2object,GstStructure * controls)1016 gst_v4l2_set_controls (GstV4l2Object * v4l2object, GstStructure * controls)
1017 {
1018 return gst_structure_foreach (controls, set_control, v4l2object);
1019 }
1020
1021 gboolean
gst_v4l2_get_input(GstV4l2Object * v4l2object,gint * input)1022 gst_v4l2_get_input (GstV4l2Object * v4l2object, gint * input)
1023 {
1024 gint n;
1025
1026 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "trying to get input");
1027
1028 if (!GST_V4L2_IS_OPEN (v4l2object))
1029 return FALSE;
1030
1031 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_G_INPUT, &n) < 0)
1032 goto input_failed;
1033
1034 *input = n;
1035
1036 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "input: %d", n);
1037
1038 return TRUE;
1039
1040 /* ERRORS */
1041 input_failed:
1042 if (v4l2object->device_caps & V4L2_CAP_TUNER) {
1043 /* only give a warning message if driver actually claims to have tuner
1044 * support
1045 */
1046 GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
1047 (_("Failed to get current input on device '%s'. May be it is a radio device"), v4l2object->videodev), GST_ERROR_SYSTEM);
1048 }
1049 return FALSE;
1050 }
1051
1052 gboolean
gst_v4l2_set_input(GstV4l2Object * v4l2object,gint input)1053 gst_v4l2_set_input (GstV4l2Object * v4l2object, gint input)
1054 {
1055 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "trying to set input to %d", input);
1056
1057 if (!GST_V4L2_IS_OPEN (v4l2object))
1058 return FALSE;
1059
1060 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_S_INPUT, &input) < 0)
1061 goto input_failed;
1062
1063 return TRUE;
1064
1065 /* ERRORS */
1066 input_failed:
1067 if (v4l2object->device_caps & V4L2_CAP_TUNER) {
1068 /* only give a warning message if driver actually claims to have tuner
1069 * support
1070 */
1071 GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
1072 (_("Failed to set input %d on device %s."),
1073 input, v4l2object->videodev), GST_ERROR_SYSTEM);
1074 }
1075 return FALSE;
1076 }
1077
1078 gboolean
gst_v4l2_get_output(GstV4l2Object * v4l2object,gint * output)1079 gst_v4l2_get_output (GstV4l2Object * v4l2object, gint * output)
1080 {
1081 gint n;
1082
1083 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "trying to get output");
1084
1085 if (!GST_V4L2_IS_OPEN (v4l2object))
1086 return FALSE;
1087
1088 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_G_OUTPUT, &n) < 0)
1089 goto output_failed;
1090
1091 *output = n;
1092
1093 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "output: %d", n);
1094
1095 return TRUE;
1096
1097 /* ERRORS */
1098 output_failed:
1099 if (v4l2object->device_caps & V4L2_CAP_TUNER) {
1100 /* only give a warning message if driver actually claims to have tuner
1101 * support
1102 */
1103 GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
1104 (_("Failed to get current output on device '%s'. May be it is a radio device"), v4l2object->videodev), GST_ERROR_SYSTEM);
1105 }
1106 return FALSE;
1107 }
1108
1109 gboolean
gst_v4l2_set_output(GstV4l2Object * v4l2object,gint output)1110 gst_v4l2_set_output (GstV4l2Object * v4l2object, gint output)
1111 {
1112 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "trying to set output to %d", output);
1113
1114 if (!GST_V4L2_IS_OPEN (v4l2object))
1115 return FALSE;
1116
1117 if (v4l2object->ioctl (v4l2object->video_fd, VIDIOC_S_OUTPUT, &output) < 0)
1118 goto output_failed;
1119
1120 return TRUE;
1121
1122 /* ERRORS */
1123 output_failed:
1124 if (v4l2object->device_caps & V4L2_CAP_TUNER) {
1125 /* only give a warning message if driver actually claims to have tuner
1126 * support
1127 */
1128 GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
1129 (_("Failed to set output %d on device %s."),
1130 output, v4l2object->videodev), GST_ERROR_SYSTEM);
1131 }
1132 return FALSE;
1133 }
1134