qtmobility/plugins/multimedia/gstreamer/mediacapture/qgstreamerv4l2input.cpp
changeset 4 90517678cc4f
child 11 06b8e2af4411
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/qtmobility/plugins/multimedia/gstreamer/mediacapture/qgstreamerv4l2input.cpp	Mon May 03 13:18:40 2010 +0300
@@ -0,0 +1,297 @@
+/****************************************************************************
+**
+** Copyright (C) 2009 Nokia Corporation and/or its subsidiary(-ies).
+** All rights reserved.
+** Contact: Nokia Corporation (qt-info@nokia.com)
+**
+** This file is part of the Qt Mobility Components.
+**
+** $QT_BEGIN_LICENSE:LGPL$
+** No Commercial Usage
+** This file contains pre-release code and may not be distributed.
+** You may use this file in accordance with the terms and conditions
+** contained in the Technology Preview License Agreement accompanying
+** this package.
+**
+** GNU Lesser General Public License Usage
+** Alternatively, this file may be used under the terms of the GNU Lesser
+** General Public License version 2.1 as published by the Free Software
+** Foundation and appearing in the file LICENSE.LGPL included in the
+** packaging of this file.  Please review the following information to
+** ensure the GNU Lesser General Public License version 2.1 requirements
+** will be met: http://www.gnu.org/licenses/old-licenses/lgpl-2.1.html.
+**
+** In addition, as a special exception, Nokia gives you certain additional
+** rights.  These rights are described in the Nokia Qt LGPL Exception
+** version 1.1, included in the file LGPL_EXCEPTION.txt in this package.
+**
+** If you have questions regarding the use of this file, please contact
+** Nokia at qt-info@nokia.com.
+**
+**
+**
+**
+**
+**
+**
+**
+** $QT_END_LICENSE$
+**
+****************************************************************************/
+
+#include "qgstreamerv4l2input.h"
+
+#include <QtCore/qdebug.h>
+#include <QtCore/qfile.h>
+
+#include <linux/types.h>
+#include <sys/time.h>
+#include <sys/ioctl.h>
+#include <sys/poll.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <string.h>
+#include <stdlib.h>
+#include <sys/mman.h>
+#include <linux/videodev2.h>
+
+QT_BEGIN_NAMESPACE
+static inline uint qHash(const QSize& key) { return uint(key.width()*256+key.height()); }
+
+static bool operator<(const QSize &s1, const QSize s2)
+{
+    return s1.width()*s1.height() < s2.width()*s2.height();
+}
+QT_END_NAMESPACE
+
+QGstreamerV4L2Input::QGstreamerV4L2Input(QObject *parent)
+    :QObject(parent)
+{
+}
+
+QGstreamerV4L2Input::~QGstreamerV4L2Input()
+{
+}
+
+GstElement *QGstreamerV4L2Input::buildElement()
+{
+#ifndef Q_WS_MAEMO_5
+    GstElement *camera = gst_element_factory_make("v4l2src", "camera_source");
+#else
+    GstElement *camera = gst_element_factory_make("v4l2camsrc", "camera_source");
+#endif
+    if (camera && !m_device.isEmpty() )
+        g_object_set(G_OBJECT(camera), "device", m_device.constData(), NULL);
+
+    return camera;
+}
+
+void QGstreamerV4L2Input::setDevice(const QByteArray &newDevice)
+{
+    if (m_device != newDevice) {
+        m_device = newDevice;
+        updateSupportedResolutions(newDevice);
+    }
+}
+
+void QGstreamerV4L2Input::setDevice(const QString &device)
+{
+    setDevice(QFile::encodeName(device));
+}
+
+void QGstreamerV4L2Input::updateSupportedResolutions(const QByteArray &device)
+{
+    m_frameRates.clear();
+    m_resolutions.clear();
+    m_ratesByResolution.clear();
+
+    QSet<QSize> allResolutions;
+    QSet<int> allFrameRates;
+
+    QFile f(device);
+
+    if (!f.open(QFile::ReadOnly))
+        return;
+
+    int fd = f.handle();
+
+    //get the list of formats:
+    QList<quint32> supportedFormats;
+
+    {
+        v4l2_fmtdesc fmt;
+        memset(&fmt, 0, sizeof(v4l2_fmtdesc));
+
+        fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
+        int sanity = 0;
+
+        for (fmt.index = 0;; fmt.index++) {
+            if (sanity++ > 8)
+                break;
+            if(  ::ioctl(fd, VIDIOC_ENUM_FMT, &fmt) == -1) {
+                if(errno == EINVAL)
+                    break;
+            }
+            supportedFormats.append(fmt.pixelformat);
+        }
+    }
+
+    QList<QSize> commonSizes;
+    commonSizes << QSize(128, 96)
+            <<QSize(160,120)
+            <<QSize(176, 144)
+            <<QSize(320, 240)
+            <<QSize(352, 288)
+            <<QSize(640, 480)
+            <<QSize(1024, 768)
+            <<QSize(1280, 1024)
+            <<QSize(1600, 1200)
+            <<QSize(1920, 1200)
+            <<QSize(2048, 1536)
+            <<QSize(2560, 1600)
+            <<QSize(2580, 1936);
+
+    QList<int> commonRates;
+    commonRates << 05*1000 << 75*1000  << 10*1000 << 15*1000 << 20*1000
+            << 24*1000 << 25*1000 << 30*1000 << 50*1000 << 60*1000;
+
+
+    //get the list of resolutions:
+
+    foreach (quint32 format, supportedFormats) {
+        struct v4l2_frmsizeenum formatSize;
+        memset(&formatSize, 0, sizeof(formatSize));
+        formatSize.pixel_format = format;
+
+        QList<QSize> sizeList;
+
+        if (0) {
+            char formatStr[5];
+            memcpy(formatStr, &format, 4);
+            formatStr[4] = 0;
+            //qDebug() << "trying format" << formatStr;
+        }
+
+        for (int i=0;;i++) {
+            formatSize.index = i;
+            if (ioctl (fd, VIDIOC_ENUM_FRAMESIZES, &formatSize) < 0)
+                break;
+
+            if (formatSize.type == V4L2_FRMSIZE_TYPE_DISCRETE) {
+                sizeList.append(QSize(formatSize.discrete.width, formatSize.discrete.height));
+            } else {
+
+                foreach (const QSize& candidate, commonSizes) {
+                    if (candidate.width() <= (int)formatSize.stepwise.max_width &&
+                        candidate.height() >= (int)formatSize.stepwise.min_width &&
+                        candidate.width() % formatSize.stepwise.step_width == 0 &&
+                        candidate.height() <= (int)formatSize.stepwise.max_height &&
+                        candidate.height() >= (int)formatSize.stepwise.min_height &&
+                        candidate.height() % formatSize.stepwise.step_height == 0) {
+                        sizeList.append(candidate);
+                    }
+                }
+
+                if (!sizeList.contains(QSize(formatSize.stepwise.min_width, formatSize.stepwise.min_height)))
+                    sizeList.prepend(QSize(formatSize.stepwise.min_width, formatSize.stepwise.min_height));
+
+                if (!sizeList.contains(QSize(formatSize.stepwise.max_width, formatSize.stepwise.max_height)))
+                    sizeList.append(QSize(formatSize.stepwise.max_width, formatSize.stepwise.max_height));
+
+                break; //stepwise values are returned only for index 0
+            }
+
+        }
+
+        //and frameRates for each resolution.
+
+        foreach (const QSize &s, sizeList) {
+            allResolutions.insert(s);
+
+            struct v4l2_frmivalenum formatInterval;
+            memset(&formatInterval, 0, sizeof(formatInterval));
+            formatInterval.pixel_format = format;
+            formatInterval.width = s.width();
+            formatInterval.height = s.height();
+
+            QList<int> frameRates; //in 1/1000 of fps
+
+            for (int i=0; ; i++) {
+                formatInterval.index = i;
+
+                if (ioctl(fd, VIDIOC_ENUM_FRAMEINTERVALS, &formatInterval) < 0)
+                    break;
+
+                if (formatInterval.type == V4L2_FRMIVAL_TYPE_DISCRETE) {
+                    //converts seconds to fps*1000
+                    if (formatInterval.discrete.numerator)
+                        frameRates.append(qRound(formatInterval.discrete.denominator*1000.0 / formatInterval.discrete.numerator));
+                } else {
+                    if (formatInterval.stepwise.min.numerator == 0 ||
+                        formatInterval.stepwise.max.numerator == 0) {
+                        qWarning() << "received invalid frame interval";
+                        break;
+                    }
+
+
+                    int minRate = qRound(formatInterval.stepwise.min.denominator*1000.0 /
+                                         formatInterval.stepwise.min.numerator);
+
+                    int maxRate = qRound(formatInterval.stepwise.max.denominator*1000.0 /
+                                         formatInterval.stepwise.max.numerator);
+
+
+                    foreach (int candidate, commonRates) {
+                        if (candidate >= minRate && candidate <= maxRate)
+                            frameRates.append(candidate);
+                    }
+
+                    if (!frameRates.contains(minRate))
+                        frameRates.prepend(minRate);
+
+                    if (!frameRates.contains(maxRate))
+                        frameRates.append(maxRate);
+
+                    break; //stepwise values are returned only for index 0
+                }
+            }
+            allFrameRates.unite(frameRates.toSet());
+            m_ratesByResolution[s].unite(frameRates.toSet());
+        }
+    }
+
+    f.close();
+
+    foreach(int rate, allFrameRates) {
+        m_frameRates.append(rate/1000.0);
+    }
+
+    qSort(m_frameRates);
+
+    m_resolutions = allResolutions.toList();
+    qSort(m_resolutions);
+
+    //qDebug() << "frame rates:" << m_frameRates;
+    //qDebug() << "resolutions:" << m_resolutions;
+}
+
+
+QList<qreal> QGstreamerV4L2Input::supportedFrameRates(const QSize &frameSize) const
+{
+    if (frameSize.isEmpty())
+        return m_frameRates;
+    else {
+        QList<qreal> res;
+        foreach(int rate, m_ratesByResolution[frameSize]) {
+            res.append(rate/1000.0);
+        }
+        return res;
+    }
+}
+
+QList<QSize> QGstreamerV4L2Input::supportedResolutions(qreal frameRate) const
+{
+    Q_UNUSED(frameRate);
+    return m_resolutions;
+}