VideoReceiver.cc 30.1 KB
Newer Older
1 2 3 4 5 6 7 8
/****************************************************************************
 *
 *   (c) 2009-2016 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
 *
 * QGroundControl is licensed according to the terms in the file
 * COPYING.md in the root of the source code directory.
 *
 ****************************************************************************/
Gus Grubba's avatar
Gus Grubba committed
9 10 11 12 13 14 15 16 17


/**
 * @file
 *   @brief QGC Video Receiver
 *   @author Gus Grubba <mavlink@grubba.com>
 */

#include "VideoReceiver.h"
18 19
#include "SettingsManager.h"
#include "QGCApplication.h"
20
#include "VideoManager.h"
21

Gus Grubba's avatar
Gus Grubba committed
22
#include <QDebug>
23
#include <QUrl>
24 25
#include <QDir>
#include <QDateTime>
26
#include <QSysInfo>
27

28 29
QGC_LOGGING_CATEGORY(VideoReceiverLog, "VideoReceiverLog")

30 31
#if defined(QGC_GST_STREAMING)

32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47
static const char* kVideoExtensions[] =
{
    "mkv",
    "mov",
    "mp4"
};

static const char* kVideoMuxes[] =
{
    "matroskamux",
    "qtmux",
    "mp4mux"
};

#define NUM_MUXES (sizeof(kVideoMuxes) / sizeof(char*))

48 49 50
#endif


Gus Grubba's avatar
Gus Grubba committed
51 52
VideoReceiver::VideoReceiver(QObject* parent)
    : QObject(parent)
53
#if defined(QGC_GST_STREAMING)
54
    , _running(false)
55
    , _recording(false)
56
    , _streaming(false)
57 58
    , _starting(false)
    , _stopping(false)
59 60 61
    , _sink(NULL)
    , _tee(NULL)
    , _pipeline(NULL)
62
    , _pipelineStopRec(NULL)
Gus Grubba's avatar
Gus Grubba committed
63
    , _videoSink(NULL)
64 65
    , _socket(NULL)
    , _serverPresent(false)
66
    , _rtspTestInterval_ms(5000)
67
#endif
68 69 70
    , _videoSurface(NULL)
    , _videoRunning(false)
    , _showFullScreen(false)
71
    , _videoSettings(NULL)
Gus Grubba's avatar
Gus Grubba committed
72
{
73 74
    _videoSurface = new VideoSurface;
    _videoSettings = qgcApp()->toolbox()->settingsManager()->videoSettings();
75
#if defined(QGC_GST_STREAMING)
76
    _setVideoSink(_videoSurface->videoSink());
77 78
    _timer.setSingleShot(true);
    connect(&_timer, &QTimer::timeout, this, &VideoReceiver::_timeout);
79 80 81
    connect(this, &VideoReceiver::msgErrorReceived, this, &VideoReceiver::_handleError);
    connect(this, &VideoReceiver::msgEOSReceived, this, &VideoReceiver::_handleEOS);
    connect(this, &VideoReceiver::msgStateChangedReceived, this, &VideoReceiver::_handleStateChanged);
82 83
    connect(&_frameTimer, &QTimer::timeout, this, &VideoReceiver::_updateTimer);
    _frameTimer.start(1000);
84
#endif
Gus Grubba's avatar
Gus Grubba committed
85 86 87 88
}

VideoReceiver::~VideoReceiver()
{
89
#if defined(QGC_GST_STREAMING)
90 91 92 93
    stop();
    if(_socket) {
        delete _socket;
    }
94 95 96
    if (_videoSink) {
        gst_object_unref(_videoSink);
    }
97
#endif
98 99
    if(_videoSurface)
        delete _videoSurface;
Gus Grubba's avatar
Gus Grubba committed
100 101
}

102
#if defined(QGC_GST_STREAMING)
103 104
void
VideoReceiver::_setVideoSink(GstElement* sink)
Gus Grubba's avatar
Gus Grubba committed
105 106 107 108 109 110 111 112 113 114
{
    if (_videoSink) {
        gst_object_unref(_videoSink);
        _videoSink = NULL;
    }
    if (sink) {
        _videoSink = sink;
        gst_object_ref_sink(_videoSink);
    }
}
115
#endif
Gus Grubba's avatar
Gus Grubba committed
116

117 118 119 120 121 122 123 124 125
//-----------------------------------------------------------------------------
void
VideoReceiver::grabImage(QString imageFile)
{
    _imageFile = imageFile;
    emit imageFileChanged();
}

//-----------------------------------------------------------------------------
126
#if defined(QGC_GST_STREAMING)
127 128
static void
newPadCB(GstElement* element, GstPad* pad, gpointer data)
129
{
130
    gchar* name;
131
    name = gst_pad_get_name(pad);
132
    //g_print("A new pad %s was created\n", name);
133 134
    GstCaps* p_caps = gst_pad_get_pad_template_caps (pad);
    gchar* description = gst_caps_to_string(p_caps);
135
    qCDebug(VideoReceiverLog) << p_caps << ", " << description;
136
    g_free(description);
137 138
    GstElement* sink = GST_ELEMENT(data);
    if(gst_element_link_pads(element, name, sink, "sink") == false)
139 140 141
        qCritical() << "newPadCB : failed to link elements\n";
    g_free(name);
}
142
#endif
143

144
//-----------------------------------------------------------------------------
145
#if defined(QGC_GST_STREAMING)
146 147
void
VideoReceiver::_connected()
148 149 150
{
    //-- Server showed up. Now we start the stream.
    _timer.stop();
151
    _socket->deleteLater();
152
    _socket = NULL;
153
    if(_videoSettings->streamEnabled()->rawValue().toBool()) {
Gus Grubba's avatar
Gus Grubba committed
154 155 156
        _serverPresent = true;
        start();
    }
157 158 159
}
#endif

160
//-----------------------------------------------------------------------------
161
#if defined(QGC_GST_STREAMING)
162 163
void
VideoReceiver::_socketError(QAbstractSocket::SocketError socketError)
164 165
{
    Q_UNUSED(socketError);
166
    _socket->deleteLater();
167
    _socket = NULL;
168
    //-- Try again in a while
169
    if(_videoSettings->streamEnabled()->rawValue().toBool()) {
170
        _timer.start(_rtspTestInterval_ms);
Gus Grubba's avatar
Gus Grubba committed
171
    }
172 173 174
}
#endif

175
//-----------------------------------------------------------------------------
176
#if defined(QGC_GST_STREAMING)
177 178
void
VideoReceiver::_timeout()
179 180 181 182 183 184
{
    //-- If socket is live, we got no connection nor a socket error
    if(_socket) {
        delete _socket;
        _socket = NULL;
    }
185
    if(_videoSettings->streamEnabled()->rawValue().toBool()) {
Gus Grubba's avatar
Gus Grubba committed
186 187 188 189 190 191
        //-- RTSP will try to connect to the server. If it cannot connect,
        //   it will simply give up and never try again. Instead, we keep
        //   attempting a connection on this timer. Once a connection is
        //   found to be working, only then we actually start the stream.
        QUrl url(_uri);
        _socket = new QTcpSocket;
192 193 194
        QNetworkProxy tempProxy;
        tempProxy.setType(QNetworkProxy::DefaultProxy);
        _socket->setProxy(tempProxy);
Gus Grubba's avatar
Gus Grubba committed
195 196 197
        connect(_socket, static_cast<void (QTcpSocket::*)(QAbstractSocket::SocketError)>(&QTcpSocket::error), this, &VideoReceiver::_socketError);
        connect(_socket, &QTcpSocket::connected, this, &VideoReceiver::_connected);
        _socket->connectToHost(url.host(), url.port());
198
        _timer.start(_rtspTestInterval_ms);
Gus Grubba's avatar
Gus Grubba committed
199
    }
200 201 202
}
#endif

203
//-----------------------------------------------------------------------------
204 205 206 207 208 209 210 211 212
// When we finish our pipeline will look like this:
//
//                                   +-->queue-->decoder-->_videosink
//                                   |
//    datasource-->demux-->parser-->tee
//
//                                   ^
//                                   |
//                                   +-Here we will later link elements for recording
213 214
void
VideoReceiver::start()
Gus Grubba's avatar
Gus Grubba committed
215
{
216 217
    if(!_videoSettings->streamEnabled()->rawValue().toBool() ||
       !_videoSettings->streamConfigured()) {
218 219 220
        qCDebug(VideoReceiverLog) << "start() but not enabled/configured";
        return;
    }
221
#if defined(QGC_GST_STREAMING)
222
    _stop = false;
223 224
    qCDebug(VideoReceiverLog) << "start()";

Gus Grubba's avatar
Gus Grubba committed
225 226 227 228 229 230 231 232
    if (_uri.isEmpty()) {
        qCritical() << "VideoReceiver::start() failed because URI is not specified";
        return;
    }
    if (_videoSink == NULL) {
        qCritical() << "VideoReceiver::start() failed because video sink is not set";
        return;
    }
233 234 235 236
    if(_running) {
        qCDebug(VideoReceiverLog) << "Already running!";
        return;
    }
Gus Grubba's avatar
Gus Grubba committed
237

238
    _starting = true;
239

240 241
    bool isUdp  = _uri.contains("udp://");
    bool isRtsp = _uri.contains("rtsp://");
242
    bool isTCP  = _uri.contains("tcp://");
Gus Grubba's avatar
Gus Grubba committed
243

244 245
    //-- For RTSP and TCP, check to see if server is there first
    if(!_serverPresent && (isRtsp || isTCP)) {
246 247 248 249
        _timer.start(100);
        return;
    }

Gus Grubba's avatar
Gus Grubba committed
250
    bool running = false;
251
    bool pipelineUp = false;
Gus Grubba's avatar
Gus Grubba committed
252 253 254 255 256

    GstElement*     dataSource  = NULL;
    GstCaps*        caps        = NULL;
    GstElement*     demux       = NULL;
    GstElement*     parser      = NULL;
257
    GstElement*     queue       = NULL;
Gus Grubba's avatar
Gus Grubba committed
258
    GstElement*     decoder     = NULL;
259
    GstElement*     queue1      = NULL;
260

Gus Grubba's avatar
Gus Grubba committed
261 262
    do {
        if ((_pipeline = gst_pipeline_new("receiver")) == NULL) {
263
            qCritical() << "VideoReceiver::start() failed. Error with gst_pipeline_new()";
Gus Grubba's avatar
Gus Grubba committed
264 265 266
            break;
        }

267 268
        if(isUdp) {
            dataSource = gst_element_factory_make("udpsrc", "udp-source");
269 270
        } else if(isTCP) {
            dataSource = gst_element_factory_make("tcpclientsrc", "tcpclient-source");
271 272
        } else {
            dataSource = gst_element_factory_make("rtspsrc", "rtsp-source");
Gus Grubba's avatar
Gus Grubba committed
273 274
        }

275 276
        if (!dataSource) {
            qCritical() << "VideoReceiver::start() failed. Error with data source for gst_element_factory_make()";
Gus Grubba's avatar
Gus Grubba committed
277 278 279
            break;
        }

280 281 282 283 284 285
        if(isUdp) {
            if ((caps = gst_caps_from_string("application/x-rtp, media=(string)video, clock-rate=(int)90000, encoding-name=(string)H264")) == NULL) {
                qCritical() << "VideoReceiver::start() failed. Error with gst_caps_from_string()";
                break;
            }
            g_object_set(G_OBJECT(dataSource), "uri", qPrintable(_uri), "caps", caps, NULL);
286 287 288
        } else if(isTCP) {
            QUrl url(_uri);
            g_object_set(G_OBJECT(dataSource), "host", qPrintable(url.host()), "port", url.port(), NULL );
289
        } else {
290
            g_object_set(G_OBJECT(dataSource), "location", qPrintable(_uri), "latency", 17, "udp-reconnect", 1, "timeout", static_cast<guint64>(5000000), NULL);
291
        }
Gus Grubba's avatar
Gus Grubba committed
292

293 294 295 296 297 298 299 300 301 302 303
        // Currently, we expect H264 when using anything except for TCP.  Long term we may want this to be settable
        if (isTCP) {
            if ((demux = gst_element_factory_make("tsdemux", "mpeg2-ts-demuxer")) == NULL) {
                qCritical() << "VideoReceiver::start() failed. Error with gst_element_factory_make('tsdemux')";
                break;
            }
        } else {
            if ((demux = gst_element_factory_make("rtph264depay", "rtp-h264-depacketizer")) == NULL) {
                qCritical() << "VideoReceiver::start() failed. Error with gst_element_factory_make('rtph264depay')";
                break;
            }
304 305
        }

Gus Grubba's avatar
Gus Grubba committed
306
        if ((parser = gst_element_factory_make("h264parse", "h264-parser")) == NULL) {
307
            qCritical() << "VideoReceiver::start() failed. Error with gst_element_factory_make('h264parse')";
Gus Grubba's avatar
Gus Grubba committed
308 309 310
            break;
        }

311
        if((_tee = gst_element_factory_make("tee", NULL)) == NULL)  {
312 313 314
            qCritical() << "VideoReceiver::start() failed. Error with gst_element_factory_make('tee')";
            break;
        }
Gus Grubba's avatar
Gus Grubba committed
315

316
        if((queue = gst_element_factory_make("queue", NULL)) == NULL)  {
317 318
            // TODO: We may want to add queue2 max-size-buffers=1 to get lower latency
            //       We should compare gstreamer scripts to QGroundControl to determine the need
319
            qCritical() << "VideoReceiver::start() failed. Error with gst_element_factory_make('queue')";
320 321
            break;
        }
322

323 324 325 326 327 328 329 330 331 332 333
        if ((decoder = gst_element_factory_make("avdec_h264", "h264-decoder")) == NULL) {
            qCritical() << "VideoReceiver::start() failed. Error with gst_element_factory_make('avdec_h264')";
            break;
        }

        if ((queue1 = gst_element_factory_make("queue", NULL)) == NULL) {
            qCritical() << "VideoReceiver::start() failed. Error with gst_element_factory_make('queue') [1]";
            break;
        }

        gst_bin_add_many(GST_BIN(_pipeline), dataSource, demux, parser, _tee, queue, decoder, queue1, _videoSink, NULL);
334
        pipelineUp = true;
335

336 337
        if(isUdp) {
            // Link the pipeline in front of the tee
338
            if(!gst_element_link_many(dataSource, demux, parser, _tee, queue, decoder, queue1, _videoSink, NULL)) {
339 340 341 342 343 344 345 346 347 348
                qCritical() << "Unable to link UDP elements.";
                break;
            }
        } else if (isTCP) {
            if(!gst_element_link(dataSource, demux)) {
                qCritical() << "Unable to link TCP dataSource to Demux.";
                break;
            }
            if(!gst_element_link_many(parser, _tee, queue, decoder, queue1, _videoSink, NULL)) {
                qCritical() << "Unable to link TCP pipline to parser.";
349 350
                break;
            }
351
            g_signal_connect(demux, "pad-added", G_CALLBACK(newPadCB), parser);
352
        } else {
353
            g_signal_connect(dataSource, "pad-added", G_CALLBACK(newPadCB), demux);
354
            if(!gst_element_link_many(demux, parser, _tee, queue, decoder, _videoSink, NULL)) {
355
                qCritical() << "Unable to link RTSP elements.";
356 357
                break;
            }
358 359
        }

360
        dataSource = demux = parser = queue = decoder = queue1 = NULL;
Gus Grubba's avatar
Gus Grubba committed
361

362
        GstBus* bus = NULL;
Gus Grubba's avatar
Gus Grubba committed
363

364 365 366 367 368 369
        if ((bus = gst_pipeline_get_bus(GST_PIPELINE(_pipeline))) != NULL) {
            gst_bus_enable_sync_message_emission(bus);
            g_signal_connect(bus, "sync-message", G_CALLBACK(_onBusMessage), this);
            gst_object_unref(bus);
            bus = NULL;
        }
Gus Grubba's avatar
Gus Grubba committed
370

371
        GST_DEBUG_BIN_TO_DOT_FILE(GST_BIN(_pipeline), GST_DEBUG_GRAPH_SHOW_ALL, "pipeline-paused");
Gus Grubba's avatar
Gus Grubba committed
372 373 374 375 376 377 378 379 380 381 382 383
        running = gst_element_set_state(_pipeline, GST_STATE_PLAYING) != GST_STATE_CHANGE_FAILURE;

    } while(0);

    if (caps != NULL) {
        gst_caps_unref(caps);
        caps = NULL;
    }

    if (!running) {
        qCritical() << "VideoReceiver::start() failed";

384 385 386 387
        // In newer versions, the pipeline will clean up all references that are added to it
        if (_pipeline != NULL) {
            gst_object_unref(_pipeline);
            _pipeline = NULL;
Gus Grubba's avatar
Gus Grubba committed
388 389
        }

390 391 392 393 394 395
        // If we failed before adding items to the pipeline, then clean up
        if (!pipelineUp) {
            if (decoder != NULL) {
                gst_object_unref(decoder);
                decoder = NULL;
            }
Gus Grubba's avatar
Gus Grubba committed
396

397 398 399 400
            if (parser != NULL) {
                gst_object_unref(parser);
                parser = NULL;
            }
Gus Grubba's avatar
Gus Grubba committed
401

402 403 404 405
            if (demux != NULL) {
                gst_object_unref(demux);
                demux = NULL;
            }
Gus Grubba's avatar
Gus Grubba committed
406

407 408 409 410
            if (dataSource != NULL) {
                gst_object_unref(dataSource);
                dataSource = NULL;
            }
411

412 413 414 415
            if (_tee != NULL) {
                gst_object_unref(_tee);
                dataSource = NULL;
            }
416

417 418 419 420
            if (queue != NULL) {
                gst_object_unref(queue);
                dataSource = NULL;
            }
Gus Grubba's avatar
Gus Grubba committed
421
        }
422 423 424

        _running = false;
    } else {
425
        GST_DEBUG_BIN_TO_DOT_FILE(GST_BIN(_pipeline), GST_DEBUG_GRAPH_SHOW_ALL, "pipeline-playing");
426 427
        _running = true;
        qCDebug(VideoReceiverLog) << "Running";
Gus Grubba's avatar
Gus Grubba committed
428
    }
429
    _starting = false;
430
#endif
Gus Grubba's avatar
Gus Grubba committed
431 432
}

433 434 435
//-----------------------------------------------------------------------------
void
VideoReceiver::stop()
Gus Grubba's avatar
Gus Grubba committed
436
{
437
#if defined(QGC_GST_STREAMING)
438
    _stop = true;
439
    qCDebug(VideoReceiverLog) << "stop()";
440 441 442
    if(!_streaming) {
        _shutdownPipeline();
    } else if (_pipeline != NULL && !_stopping) {
443 444 445 446
        qCDebug(VideoReceiverLog) << "Stopping _pipeline";
        gst_element_send_event(_pipeline, gst_event_new_eos());
        _stopping = true;
        GstBus* bus = gst_pipeline_get_bus(GST_PIPELINE(_pipeline));
447
        GstMessage* message = gst_bus_timed_pop_filtered(bus, GST_CLOCK_TIME_NONE, (GstMessageType)(GST_MESSAGE_EOS|GST_MESSAGE_ERROR));
448
        gst_object_unref(bus);
449 450 451 452 453 454
        if(GST_MESSAGE_TYPE(message) == GST_MESSAGE_ERROR) {
            _shutdownPipeline();
            qCritical() << "Error stopping pipeline!";
        } else if(GST_MESSAGE_TYPE(message) == GST_MESSAGE_EOS) {
            _handleEOS();
        }
455
        gst_message_unref(message);
Gus Grubba's avatar
Gus Grubba committed
456
    }
457
#endif
Gus Grubba's avatar
Gus Grubba committed
458 459
}

460 461 462
//-----------------------------------------------------------------------------
void
VideoReceiver::setUri(const QString & uri)
Gus Grubba's avatar
Gus Grubba committed
463 464 465 466
{
    _uri = uri;
}

467
//-----------------------------------------------------------------------------
468
#if defined(QGC_GST_STREAMING)
469 470
void
VideoReceiver::_shutdownPipeline() {
471 472 473 474
    if(!_pipeline) {
        qCDebug(VideoReceiverLog) << "No pipeline";
        return;
    }
475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493
    GstBus* bus = NULL;
    if ((bus = gst_pipeline_get_bus(GST_PIPELINE(_pipeline))) != NULL) {
        gst_bus_disable_sync_message_emission(bus);
        gst_object_unref(bus);
        bus = NULL;
    }
    gst_element_set_state(_pipeline, GST_STATE_NULL);
    gst_bin_remove(GST_BIN(_pipeline), _videoSink);
    gst_object_unref(_pipeline);
    _pipeline = NULL;
    delete _sink;
    _sink = NULL;
    _serverPresent = false;
    _streaming = false;
    _recording = false;
    _stopping = false;
    _running = false;
    emit recordingChanged();
}
494
#endif
495

496
//-----------------------------------------------------------------------------
497
#if defined(QGC_GST_STREAMING)
498 499
void
VideoReceiver::_handleError() {
500 501 502 503 504
    qCDebug(VideoReceiverLog) << "Gstreamer error!";
    _shutdownPipeline();
}
#endif

505
//-----------------------------------------------------------------------------
506
#if defined(QGC_GST_STREAMING)
507 508
void
VideoReceiver::_handleEOS() {
509 510
    if(_stopping) {
        _shutdownPipeline();
511
        qCDebug(VideoReceiverLog) << "Stopped";
512 513 514
    } else if(_recording && _sink->removing) {
        _shutdownRecordingBranch();
    } else {
515
        qWarning() << "VideoReceiver: Unexpected EOS!";
516
        _shutdownPipeline();
Gus Grubba's avatar
Gus Grubba committed
517 518
    }
}
519
#endif
Gus Grubba's avatar
Gus Grubba committed
520

521
//-----------------------------------------------------------------------------
522
#if defined(QGC_GST_STREAMING)
523 524 525 526 527 528
void
VideoReceiver::_handleStateChanged() {
    if(_pipeline) {
        _streaming = GST_STATE(_pipeline) == GST_STATE_PLAYING;
        qCDebug(VideoReceiverLog) << "State changed, _streaming:" << _streaming;
    }
529 530 531
}
#endif

532
//-----------------------------------------------------------------------------
533
#if defined(QGC_GST_STREAMING)
534 535
gboolean
VideoReceiver::_onBusMessage(GstBus* bus, GstMessage* msg, gpointer data)
Gus Grubba's avatar
Gus Grubba committed
536 537 538 539
{
    Q_UNUSED(bus)
    Q_ASSERT(msg != NULL && data != NULL);
    VideoReceiver* pThis = (VideoReceiver*)data;
540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561

    switch(GST_MESSAGE_TYPE(msg)) {
    case(GST_MESSAGE_ERROR): {
        gchar* debug;
        GError* error;
        gst_message_parse_error(msg, &error, &debug);
        g_free(debug);
        qCritical() << error->message;
        g_error_free(error);
        pThis->msgErrorReceived();
    }
        break;
    case(GST_MESSAGE_EOS):
        pThis->msgEOSReceived();
        break;
    case(GST_MESSAGE_STATE_CHANGED):
        pThis->msgStateChangedReceived();
        break;
    default:
        break;
    }

Gus Grubba's avatar
Gus Grubba committed
562 563
    return TRUE;
}
564
#endif
565

566
//-----------------------------------------------------------------------------
567
#if defined(QGC_GST_STREAMING)
568 569
void
VideoReceiver::_cleanupOldVideos()
570
{
571
    //-- Only perform cleanup if storage limit is enabled
572
    if(_videoSettings->enableStorageLimit()->rawValue().toBool()) {
573 574 575 576 577 578 579 580
        QString savePath = qgcApp()->toolbox()->settingsManager()->appSettings()->videoSavePath();
        QDir videoDir = QDir(savePath);
        videoDir.setFilter(QDir::Files | QDir::Readable | QDir::NoSymLinks | QDir::Writable);
        videoDir.setSorting(QDir::Time);
        //-- All the movie extensions we support
        QStringList nameFilters;
        for(uint32_t i = 0; i < NUM_MUXES; i++) {
            nameFilters << QString("*.") + QString(kVideoExtensions[i]);
581
        }
582 583 584 585 586 587
        videoDir.setNameFilters(nameFilters);
        //-- get the list of videos stored
        QFileInfoList vidList = videoDir.entryInfoList();
        if(!vidList.isEmpty()) {
            uint64_t total   = 0;
            //-- Settings are stored using MB
588
            uint64_t maxSize = (_videoSettings->maxVideoSize()->rawValue().toUInt() * 1024 * 1024);
589 590 591 592 593 594 595 596 597 598 599 600
            //-- Compute total used storage
            for(int i = 0; i < vidList.size(); i++) {
                total += vidList[i].size();
            }
            //-- Remove old movies until max size is satisfied.
            while(total >= maxSize && !vidList.isEmpty()) {
                total -= vidList.last().size();
                qCDebug(VideoReceiverLog) << "Removing old video file:" << vidList.last().filePath();
                QFile file (vidList.last().filePath());
                file.remove();
                vidList.removeLast();
            }
601 602 603
        }
    }
}
604
#endif
605

606
//-----------------------------------------------------------------------------
607 608 609 610 611 612 613 614 615 616 617
// When we finish our pipeline will look like this:
//
//                                   +-->queue-->decoder-->_videosink
//                                   |
//    datasource-->demux-->parser-->tee
//                                   |
//                                   |    +--------------_sink-------------------+
//                                   |    |                                      |
//   we are adding these elements->  +->teepad-->queue-->matroskamux-->_filesink |
//                                        |                                      |
//                                        +--------------------------------------+
618
void
619
VideoReceiver::startRecording(const QString &videoFile)
620
{
621
#if defined(QGC_GST_STREAMING)
622

623 624 625 626 627 628 629
    qCDebug(VideoReceiverLog) << "startRecording()";
    // exit immediately if we are already recording
    if(_pipeline == NULL || _recording) {
        qCDebug(VideoReceiverLog) << "Already recording!";
        return;
    }

630
    uint32_t muxIdx = _videoSettings->recordingFormat()->rawValue().toUInt();
631 632 633 634 635 636 637 638
    if(muxIdx >= NUM_MUXES) {
        qgcApp()->showMessage(tr("Invalid video format defined."));
        return;
    }

    //-- Disk usage maintenance
    _cleanupOldVideos();

639
    _sink           = new Sink();
640 641
    _sink->teepad   = gst_element_get_request_pad(_tee, "src_%u");
    _sink->queue    = gst_element_factory_make("queue", NULL);
642 643
    _sink->parse    = gst_element_factory_make("h264parse", NULL);
    _sink->mux      = gst_element_factory_make(kVideoMuxes[muxIdx], NULL);
644 645 646
    _sink->filesink = gst_element_factory_make("filesink", NULL);
    _sink->removing = false;

647
    if(!_sink->teepad || !_sink->queue || !_sink->mux || !_sink->filesink || !_sink->parse) {
648 649 650 651
        qCritical() << "VideoReceiver::startRecording() failed to make _sink elements";
        return;
    }

652 653 654 655 656 657 658 659 660 661 662
    if(videoFile.isEmpty()) {
        QString savePath = qgcApp()->toolbox()->settingsManager()->appSettings()->videoSavePath();
        if(savePath.isEmpty()) {
            qgcApp()->showMessage(tr("Unabled to record video. Video save path must be specified in Settings."));
            return;
        }
        _videoFile = savePath + "/" + QDateTime::currentDateTime().toString("yyyy-MM-dd_hh.mm.ss") + "." + kVideoExtensions[muxIdx];
    } else {
        _videoFile = videoFile;
    }
    emit videoFileChanged();
663

664 665
    g_object_set(G_OBJECT(_sink->filesink), "location", qPrintable(_videoFile), NULL);
    qCDebug(VideoReceiverLog) << "New video file:" << _videoFile;
666 667

    gst_object_ref(_sink->queue);
668
    gst_object_ref(_sink->parse);
669 670 671
    gst_object_ref(_sink->mux);
    gst_object_ref(_sink->filesink);

672 673
    gst_bin_add_many(GST_BIN(_pipeline), _sink->queue, _sink->parse, _sink->mux, _sink->filesink, NULL);
    gst_element_link_many(_sink->queue, _sink->parse, _sink->mux, _sink->filesink, NULL);
674 675

    gst_element_sync_state_with_parent(_sink->queue);
676
    gst_element_sync_state_with_parent(_sink->parse);
677 678 679
    gst_element_sync_state_with_parent(_sink->mux);
    gst_element_sync_state_with_parent(_sink->filesink);

680 681 682 683 684 685 686 687
    // Install a probe on the recording branch to drop buffers until we hit our first keyframe
    // When we hit our first keyframe, we can offset the timestamps appropriately according to the first keyframe time
    // This will ensure the first frame is a keyframe at t=0, and decoding can begin immediately on playback
    GstPad* probepad = gst_element_get_static_pad(_sink->queue, "src");
    gst_pad_add_probe(probepad, (GstPadProbeType)(GST_PAD_PROBE_TYPE_BUFFER /* | GST_PAD_PROBE_TYPE_BLOCK */), _keyframeWatch, this, NULL); // to drop the buffer or to block the buffer?
    gst_object_unref(probepad);

    // Link the recording branch to the pipeline
688 689 690 691
    GstPad* sinkpad = gst_element_get_static_pad(_sink->queue, "sink");
    gst_pad_link(_sink->teepad, sinkpad);
    gst_object_unref(sinkpad);

692 693
    GST_DEBUG_BIN_TO_DOT_FILE(GST_BIN(_pipeline), GST_DEBUG_GRAPH_SHOW_ALL, "pipeline-recording");

694 695 696
    _recording = true;
    emit recordingChanged();
    qCDebug(VideoReceiverLog) << "Recording started";
DonLakeFlyer's avatar
DonLakeFlyer committed
697 698
#else
    Q_UNUSED(videoFile)
699 700 701
#endif
}

702 703 704
//-----------------------------------------------------------------------------
void
VideoReceiver::stopRecording(void)
705
{
706
#if defined(QGC_GST_STREAMING)
707 708 709 710 711 712 713 714 715 716 717
    qCDebug(VideoReceiverLog) << "stopRecording()";
    // exit immediately if we are not recording
    if(_pipeline == NULL || !_recording) {
        qCDebug(VideoReceiverLog) << "Not recording!";
        return;
    }
    // Wait for data block before unlinking
    gst_pad_add_probe(_sink->teepad, GST_PAD_PROBE_TYPE_IDLE, _unlinkCallBack, this, NULL);
#endif
}

718
//-----------------------------------------------------------------------------
719 720 721 722 723 724
// This is only installed on the transient _pipelineStopRec in order
// to finalize a video file. It is not used for the main _pipeline.
// -EOS has appeared on the bus of the temporary pipeline
// -At this point all of the recoring elements have been flushed, and the video file has been finalized
// -Now we can remove the temporary pipeline and its elements
#if defined(QGC_GST_STREAMING)
725 726
void
VideoReceiver::_shutdownRecordingBranch()
727 728
{
    gst_bin_remove(GST_BIN(_pipelineStopRec), _sink->queue);
729
    gst_bin_remove(GST_BIN(_pipelineStopRec), _sink->parse);
730 731 732 733 734
    gst_bin_remove(GST_BIN(_pipelineStopRec), _sink->mux);
    gst_bin_remove(GST_BIN(_pipelineStopRec), _sink->filesink);

    gst_element_set_state(_pipelineStopRec, GST_STATE_NULL);
    gst_object_unref(_pipelineStopRec);
735
    _pipelineStopRec = NULL;
736

737 738 739 740
    gst_element_set_state(_sink->filesink,  GST_STATE_NULL);
    gst_element_set_state(_sink->parse,     GST_STATE_NULL);
    gst_element_set_state(_sink->mux,       GST_STATE_NULL);
    gst_element_set_state(_sink->queue,     GST_STATE_NULL);
741 742

    gst_object_unref(_sink->queue);
743
    gst_object_unref(_sink->parse);
744 745 746 747 748 749
    gst_object_unref(_sink->mux);
    gst_object_unref(_sink->filesink);

    delete _sink;
    _sink = NULL;
    _recording = false;
750

751 752 753 754 755
    emit recordingChanged();
    qCDebug(VideoReceiverLog) << "Recording Stopped";
}
#endif

756
//-----------------------------------------------------------------------------
757 758 759 760 761
// -Unlink the recording branch from the tee in the main _pipeline
// -Create a second temporary pipeline, and place the recording branch elements into that pipeline
// -Setup watch and handler for EOS event on the temporary pipeline's bus
// -Send an EOS event at the beginning of that pipeline
#if defined(QGC_GST_STREAMING)
762 763
void
VideoReceiver::_detachRecordingBranch(GstPadProbeInfo* info)
764 765 766 767
{
    Q_UNUSED(info)

    // Also unlinks and unrefs
768
    gst_bin_remove_many(GST_BIN(_pipeline), _sink->queue, _sink->parse, _sink->mux, _sink->filesink, NULL);
769 770 771 772 773 774 775 776 777

    // Give tee its pad back
    gst_element_release_request_pad(_tee, _sink->teepad);
    gst_object_unref(_sink->teepad);

    // Create temporary pipeline
    _pipelineStopRec = gst_pipeline_new("pipeStopRec");

    // Put our elements from the recording branch into the temporary pipeline
778 779
    gst_bin_add_many(GST_BIN(_pipelineStopRec), _sink->queue, _sink->parse, _sink->mux, _sink->filesink, NULL);
    gst_element_link_many(_sink->queue, _sink->parse, _sink->mux, _sink->filesink, NULL);
780

781 782 783
    // Add handler for EOS event
    GstBus* bus = gst_pipeline_get_bus(GST_PIPELINE(_pipelineStopRec));
    gst_bus_enable_sync_message_emission(bus);
784
    g_signal_connect(bus, "sync-message", G_CALLBACK(_onBusMessage), this);
785
    gst_object_unref(bus);
786 787 788 789 790 791 792 793 794 795 796 797 798

    if(gst_element_set_state(_pipelineStopRec, GST_STATE_PLAYING) == GST_STATE_CHANGE_FAILURE) {
        qCDebug(VideoReceiverLog) << "problem starting _pipelineStopRec";
    }

    // Send EOS at the beginning of the pipeline
    GstPad* sinkpad = gst_element_get_static_pad(_sink->queue, "sink");
    gst_pad_send_event(sinkpad, gst_event_new_eos());
    gst_object_unref(sinkpad);
    qCDebug(VideoReceiverLog) << "Recording branch unlinked";
}
#endif

799
//-----------------------------------------------------------------------------
800
#if defined(QGC_GST_STREAMING)
801 802
GstPadProbeReturn
VideoReceiver::_unlinkCallBack(GstPad* pad, GstPadProbeInfo* info, gpointer user_data)
803 804
{
    Q_UNUSED(pad);
805 806 807 808 809 810 811
    if(info != NULL && user_data != NULL) {
        VideoReceiver* pThis = (VideoReceiver*)user_data;
        // We will only act once
        if(g_atomic_int_compare_and_exchange(&pThis->_sink->removing, FALSE, TRUE)) {
            pThis->_detachRecordingBranch(info);
        }
    }
812 813 814
    return GST_PAD_PROBE_REMOVE;
}
#endif
815

816 817 818 819 820 821 822 823 824 825 826 827 828
//-----------------------------------------------------------------------------
#if defined(QGC_GST_STREAMING)
GstPadProbeReturn
VideoReceiver::_keyframeWatch(GstPad* pad, GstPadProbeInfo* info, gpointer user_data)
{
    Q_UNUSED(pad);
    if(info != NULL && user_data != NULL) {
        GstBuffer* buf = gst_pad_probe_info_get_buffer(info);
        if(GST_BUFFER_FLAG_IS_SET(buf, GST_BUFFER_FLAG_DELTA_UNIT)) { // wait for a keyframe
            return GST_PAD_PROBE_DROP;
        } else {
            VideoReceiver* pThis = (VideoReceiver*)user_data;
            // reset the clock
Jacob Walser's avatar
Jacob Walser committed
829
            GstClock* clock = gst_pipeline_get_clock(GST_PIPELINE(pThis->_pipeline));
830 831 832 833 834 835 836 837 838 839 840 841 842
            GstClockTime time = gst_clock_get_time(clock);
            gst_object_unref(clock);
            gst_element_set_base_time(pThis->_pipeline, time); // offset pipeline timestamps to start at zero again
            buf->dts = 0; // The offset will not apply to this current buffer, our first frame, timestamp is zero
            buf->pts = 0;
            qCDebug(VideoReceiverLog) << "Got keyframe, stop dropping buffers";
        }
    }

    return GST_PAD_PROBE_REMOVE;
}
#endif

843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864
//-----------------------------------------------------------------------------
void
VideoReceiver::_updateTimer()
{
#if defined(QGC_GST_STREAMING)
    if(_videoSurface) {
        if(stopping() || starting()) {
            return;
        }
        if(streaming()) {
            if(!_videoRunning) {
                _videoSurface->setLastFrame(0);
                _videoRunning = true;
                emit videoRunningChanged();
            }
        } else {
            if(_videoRunning) {
                _videoRunning = false;
                emit videoRunningChanged();
            }
        }
        if(_videoRunning) {
865 866
            uint32_t timeout = 1;
            if(qgcApp()->toolbox() && qgcApp()->toolbox()->settingsManager()) {
867
                timeout = _videoSettings->rtspTimeout()->rawValue().toUInt();
868
            }
869 870 871 872 873
            time_t elapsed = 0;
            time_t lastFrame = _videoSurface->lastFrame();
            if(lastFrame != 0) {
                elapsed = time(0) - _videoSurface->lastFrame();
            }
874
            if(elapsed > (time_t)timeout && _videoSurface) {
875
                stop();
876 877
                // We want to start it back again with _updateTimer
                _stop = false;
878 879
            }
        } else {
880
            if(!_stop && !running() && !_uri.isEmpty() && _videoSettings->streamEnabled()->rawValue().toBool()) {
881 882 883 884 885 886 887
                start();
            }
        }
    }
#endif
}