VehicleCameraControl.cc

Go to the documentation of this file.

#include "VehicleCameraControl.h"
#include "QGCCameraIO.h"
#include "AppMessages.h"
#include "QGCFormat.h"
#include "SettingsManager.h"
#include "AppSettings.h"
#include "VideoManager.h"
#include "QGCCameraManager.h"
#include "FTPManager.h"
#include "QGCCompression.h"
#include "QGCCorePlugin.h"
#include "QGCFileHelper.h"
#include "AppMessages.h"
#include "QGCFormat.h"
#include "Vehicle.h"
#include "VehicleLinkManager.h"
#include "LinkInterface.h"
#include "MAVLinkProtocol.h"
#include "QGCVideoStreamInfo.h"
#include "MissionCommandTree.h"
 
#include <QtNetwork/QNetworkAccessManager>
#include <QtCore/QDir>
 
#include <algorithm>
#include <QtCore/QSettings>
#include <QtXml/QDomDocument>
#include <QtXml/QDomNodeList>
#include <QtQml/QQmlEngine>
#include <QtNetwork/QNetworkReply>
 
#include "QGCNetworkHelper.h"
#include "QGCLoggingCategory.h"
 
QGC_LOGGING_CATEGORY(VehicleCameraControlLog, "Camera.VehicleCameraControl")
QGC_LOGGING_CATEGORY(VehicleCameraControlVerboseLog, "Camera.VehicleCameraControl.Verbose")
 
QGCCameraOptionExclusion::QGCCameraOptionExclusion(QObject* parent, QString param_, QString value_, QStringList exclusions_)
    : QObject(parent)
    , param(param_)
    , value(value_)
    , exclusions(exclusions_)
{
}
 
QGCCameraOptionRange::QGCCameraOptionRange(QObject* parent, QString param_, QString value_, QString targetParam_, QString condition_, QStringList optNames_, QStringList optValues_)
    : QObject(parent)
    , param(param_)
    , value(value_)
    , targetParam(targetParam_)
    , condition(condition_)
    , optNames(optNames_)
    , optValues(optValues_)
{
}
 
static bool read_attribute(QDomNode& node, const char* tagName, bool& target)
{
    QDomNamedNodeMap attrs = node.attributes();
    if(!attrs.count()) {
        return false;
    }
    QDomNode subNode = attrs.namedItem(tagName);
    if(subNode.isNull()) {
        return false;
    }
    target = subNode.nodeValue() != "0";
    return true;
}
 
static bool read_attribute(QDomNode& node, const char* tagName, int& target)
{
    QDomNamedNodeMap attrs = node.attributes();
    if(!attrs.count()) {
        return false;
    }
    QDomNode subNode = attrs.namedItem(tagName);
    if(subNode.isNull()) {
        return false;
    }
    target = subNode.nodeValue().toInt();
    return true;
}
 
static bool read_attribute(QDomNode& node, const char* tagName, QString& target)
{
    QDomNamedNodeMap attrs = node.attributes();
    if(!attrs.count()) {
        return false;
    }
    QDomNode subNode = attrs.namedItem(tagName);
    if(subNode.isNull()) {
        return false;
    }
    target = subNode.nodeValue();
    return true;
}
 
static bool read_value(QDomNode& element, const char* tagName, QString& target)
{
    QDomElement de = element.firstChildElement(tagName);
    if(de.isNull()) {
        return false;
    }
    target = de.text();
    return true;
}
 
VehicleCameraControl::VehicleCameraControl(const mavlink_camera_information_t *info, Vehicle* vehicle, int compID, QObject* parent)
    : MavlinkCameraControlInterface(vehicle, parent)
    , _compID(compID)
{
    QQmlEngine::setObjectOwnership(this, QQmlEngine::CppOwnership);
 
    memcpy(&_mavlinkCameraInfo, info, sizeof(mavlink_camera_information_t));
 
    _vendor = QString(reinterpret_cast<const char*>(info->vendor_name));
    _modelName = QString(reinterpret_cast<const char*>(info->model_name));
    _cacheFile = QString::asprintf("%s/%s_%s_%03d.xml",
                                    SettingsManager::instance()->appSettings()->parameterSavePath().toStdString().c_str(),
                                    _vendor.toStdString().c_str(),
                                    _modelName.toStdString().c_str(),
                                    static_cast<int>(_mavlinkCameraInfo.cam_definition_version));
 
    connect(this, &VehicleCameraControl::dataReady, this, &VehicleCameraControl::_dataReady);
 
    if(info->cam_definition_uri[0] != 0) {
        //-- Process camera definition file
        _handleDefinitionFile(info->cam_definition_uri);
    } else {
        _initWhenReady();
    }
 
    QSettings settings;
    _photoCaptureMode = static_cast<PhotoCaptureMode>(settings.value(kPhotoMode, static_cast<int>(PHOTO_CAPTURE_SINGLE)).toInt());
    _photoLapse = settings.value(kPhotoLapse, 1.0).toDouble();
    _photoLapseCount = settings.value(kPhotoLapseCount, 0).toInt();
    _thermalOpacity = settings.value(kThermalOpacity, 85.0).toDouble();
    _thermalMode = static_cast<ThermalViewMode>(settings.value(kThermalMode, static_cast<uint32_t>(THERMAL_BLEND)).toUInt());
 
    _videoRecordTimeUpdateTimer.setSingleShot(false);
    _videoRecordTimeUpdateTimer.setInterval(333);
    connect(&_videoRecordTimeUpdateTimer, &QTimer::timeout, this, &VehicleCameraControl::_recTimerHandler);
 
    // Cameras are not required to broadcast CAMERA_SETTINGS when zoom/focus changes,
    // so re-request it after an accepted zoom/focus command to keep zoom level and
    // FOV current. The delay also coalesces bursts of zoom/focus commands into a
    // single request.
    constexpr int kCameraSettingsRefreshDelayMsecs = 1000;
    _cameraSettingsRefreshTimer.setSingleShot(true);
    _cameraSettingsRefreshTimer.setInterval(kCameraSettingsRefreshDelayMsecs);
    connect(&_cameraSettingsRefreshTimer, &QTimer::timeout, this, [this]() {
        _cameraSettingsRetries = 0; // Start a fresh request/retry cycle
        _requestCameraSettings();
    });
 
    //-- Tracking capabilities
    _hasTrackingRectCapability = _mavlinkCameraInfo.flags & CAMERA_CAP_FLAGS_HAS_TRACKING_RECTANGLE;
    _hasTrackingPointCapability = _mavlinkCameraInfo.flags & CAMERA_CAP_FLAGS_HAS_TRACKING_POINT;
 
    qCDebug(VehicleCameraControlLog) << "Camera Info:";
    qCDebug(VehicleCameraControlLog) << "   vendor:" << vendor();
    qCDebug(VehicleCameraControlLog) << "   model:" << modelName();
    qCDebug(VehicleCameraControlLog) << "   version:" << version();
    qCDebug(VehicleCameraControlLog) << "   firmware:" << firmwareVersion();
    qCDebug(VehicleCameraControlLog) << "   focal length:" << focalLength();
    qCDebug(VehicleCameraControlLog) << "   sensor size:" << sensorSize();
    qCDebug(VehicleCameraControlLog) << "   resolution:" << resolution();
    qCDebug(VehicleCameraControlLog) << "   captures video:" << capturesVideo();
    qCDebug(VehicleCameraControlLog) << "   captures photos:" << capturesPhotos();
    qCDebug(VehicleCameraControlLog) << "   has modes:" << hasModes();
    qCDebug(VehicleCameraControlLog) << "   has zoom:" << hasZoom();
    qCDebug(VehicleCameraControlLog) << "   has focus:" << hasFocus();
    qCDebug(VehicleCameraControlLog) << "   has tracking:" << hasTracking();
    qCDebug(VehicleCameraControlLog) << "   has video stream:" << hasVideoStream();
    qCDebug(VehicleCameraControlLog) << "   photos in video mode:" << photosInVideoMode();
    qCDebug(VehicleCameraControlLog) << "   video in photo mode:" << videoInPhotoMode();
}
 
VehicleCameraControl::~VehicleCameraControl()
{
    // Stop all timers to prevent them from firing during or after destruction
    _captureStatusTimer.stop();
    _videoRecordTimeUpdateTimer.stop();
    _streamInfoTimer.stop();
    _streamStatusTimer.stop();
    _cameraSettingsTimer.stop();
    _cameraSettingsRefreshTimer.stop();
    _storageInfoTimer.stop();
 
    delete _netManager;
    _netManager = nullptr;
}
 
void VehicleCameraControl::_initWhenReady()
{
    qCDebug(VehicleCameraControlLog) << "_initWhenReady()";
    if(isBasic()) {
        qCDebug(VehicleCameraControlLog) << "Basic, MAVLink only messages, no parameters.";
        //-- Basic cameras have no parameters
        _paramComplete = true;
        emit parametersReady();
    } else {
        _requestAllParameters();
    }
 
    QTimer::singleShot(500, this, &VehicleCameraControl::_requestCameraSettings);
    connect(&_cameraSettingsTimer, &QTimer::timeout, this, &VehicleCameraControl::_cameraSettingsTimeout);
 
    QTimer::singleShot(1000, this, &VehicleCameraControl::_checkForVideoStreams);
 
    connect(_vehicle, &Vehicle::mavCommandResult, this, &VehicleCameraControl::_mavCommandResult);
 
    connect(&_captureStatusTimer, &QTimer::timeout, this, &VehicleCameraControl::_requestCaptureStatus);
    _captureStatusTimer.setSingleShot(true);
    _captureStatusTimer.start(1500);
 
    connect(&_storageInfoTimer, &QTimer::timeout, this, &VehicleCameraControl::_storageInfoTimeout);
    QTimer::singleShot(2000, this, &VehicleCameraControl::_requestStorageInfo);
 
    connect(VideoManager::instance(), &VideoManager::recordingChanged, this, &VehicleCameraControl::captureVideoStateChanged);
    connect(VideoManager::instance(), &VideoManager::recordingChanged, this, &VehicleCameraControl::_onVideoManagerRecordingChanged);
    connect(this, &VehicleCameraControl::videoCaptureStatusChanged, this, &VehicleCameraControl::captureVideoStateChanged);
    connect(this, &VehicleCameraControl::photoCaptureStatusChanged, this, &VehicleCameraControl::captureVideoStateChanged);
    connect(this, &VehicleCameraControl::cameraModeChanged, this, &VehicleCameraControl::captureVideoStateChanged);
    connect(this, &VehicleCameraControl::photoCaptureStatusChanged, this, &VehicleCameraControl::capturePhotosStateChanged);
    connect(this, &VehicleCameraControl::cameraModeChanged, this, &VehicleCameraControl::capturePhotosStateChanged);
 
    emit infoChanged();
 
    delete _netManager;
    _netManager = nullptr;
}
 
bool VehicleCameraControl::capturesVideo() const
{
    // Even if the camera itself does not report video capture capability
    // we can always save locally from a video stream, or use onboard recording
    // if the camera reports video capture capability.
    return _mavlinkCameraInfo.flags & (CAMERA_CAP_FLAGS_CAPTURE_VIDEO | CAMERA_CAP_FLAGS_HAS_VIDEO_STREAM);
}
 
bool VehicleCameraControl::capturesPhotos() const
{
    // If we have a video stream we can always screen grab from it,
    //even if the camera itself does not report still capture capability.
    return _mavlinkCameraInfo.flags & (CAMERA_CAP_FLAGS_CAPTURE_IMAGE | CAMERA_CAP_FLAGS_HAS_VIDEO_STREAM);
}
 
MavlinkCameraControlInterface::CaptureVideoState VehicleCameraControl::captureVideoState() const
{
    if (_videoCaptureStatus() == VIDEO_CAPTURE_STATUS_RUNNING || VideoManager::instance()->recording()) {
        return CaptureVideoStateCapturing;
    } else if (_photoCaptureStatus() != PHOTO_CAPTURE_IDLE) {
        return CaptureVideoStateDisabled;
    } else if (hasModes() && (_cameraMode == CAM_MODE_PHOTO || _cameraMode == CAM_MODE_SURVEY)) {
        // The ui is not set up to support recording video while in photo/survey mode, even if the camera technically supports it.
        return CaptureVideoStateDisabled;
    } else if (_mavlinkCameraInfo.flags & CAMERA_CAP_FLAGS_HAS_VIDEO_STREAM || _mavlinkCameraInfo.flags & CAMERA_CAP_FLAGS_CAPTURE_VIDEO) {
        return CaptureVideoStateIdle;
    }
 
    return CaptureVideoStateDisabled;
}
 
MavlinkCameraControlInterface::CapturePhotosState VehicleCameraControl::capturePhotosState() const
{
    if (_photoCaptureStatus() == PHOTO_CAPTURE_IN_PROGRESS) {
        return CapturePhotosStateCapturingSinglePhoto;
    } else if (_photoCaptureStatus() == PHOTO_CAPTURE_INTERVAL_IN_PROGRESS || _photoCaptureStatus() == PHOTO_CAPTURE_INTERVAL_IDLE) {
        return CapturePhotosStateCapturingMultiplePhotos;
    } else if (_photoCaptureStatus() == PHOTO_CAPTURE_IDLE) {
        // We can always do at least a screen grab from the video stream, even if camera doesn't report still capture capability
        if (_mavlinkCameraInfo.flags & CAMERA_CAP_FLAGS_HAS_VIDEO_STREAM || _mavlinkCameraInfo.flags & CAMERA_CAP_FLAGS_CAPTURE_IMAGE) {
            return CapturePhotosStateIdle;
        }
    }
 
    return CapturePhotosStateDisabled;
}
 
QString VehicleCameraControl::firmwareVersion() const
{
    if (_mavlinkCameraInfo.firmware_version == 0) {
        return {};
    }
    int major = (_mavlinkCameraInfo.firmware_version)       & 0xFF;
    int minor = (_mavlinkCameraInfo.firmware_version >> 8)  & 0xFF;
    int patch = (_mavlinkCameraInfo.firmware_version >> 16) & 0xFF;
    int dev   = (_mavlinkCameraInfo.firmware_version >> 24) & 0xFF;
    if (dev != 0) {
        return QString::asprintf("%d.%d.%d.%d", major, minor, patch, dev);
    }
    return QString::asprintf("%d.%d.%d", major, minor, patch);
}
 
QString VehicleCameraControl::recordTimeStr() const
{
    return QTime(0, 0).addMSecs(static_cast<int>(recordTime())).toString("hh:mm:ss");
}
 
QString VehicleCameraControl::storageFreeStr() const
{
    return QGC::bigSizeMBToString(static_cast<quint64>(_storageFree));
}
 
QString VehicleCameraControl::batteryRemainingStr() const
{
    if(_batteryRemaining >= 0) {
        return QGC::numberToString(static_cast<quint64>(_batteryRemaining)) + " %";
    }
    return "";
}
 
void VehicleCameraControl::setCameraModeVideo()
{
    if (_resetting) {
        return;
    }
    if (!hasModes()) {
        qCWarning(VehicleCameraControlLog) << "Camera does not support modes";
        return;
    }
 
    qCDebug(VehicleCameraControlLog) << "Camera set to video mode";
    setCameraMode(CAM_MODE_VIDEO);
}
 
void VehicleCameraControl::setCameraModePhoto()
{
    if (_resetting) {
        return;
    }
    if (!hasModes()) {
        qCWarning(VehicleCameraControlLog) << "Camera does not support modes";
        return;
    }
 
    qCDebug(VehicleCameraControlLog) << "Camera set to photo mode";
    setCameraMode(CAM_MODE_PHOTO);
}
 
void VehicleCameraControl::setCameraMode(CameraMode cameraMode)
{
    if (_resetting) {
        return;
    }
    if (!hasModes()) {
        qCWarning(VehicleCameraControlLog) << "Camera does not support modes";
        return;
    }
    if (cameraMode != CAM_MODE_PHOTO && cameraMode != CAM_MODE_VIDEO) {
        qCWarning(VehicleCameraControlLog) << "Invalid camera mode" << cameraMode;
        return;
    }
    if (_cameraMode == cameraMode) {
        return;
    }
 
    qCDebug(VehicleCameraControlLog) << "Camera mode set to" << cameraModeToStr(cameraMode);
 
    //-- Does it have a mode parameter?
    Fact* pMode = mode();
    if(pMode) {
        pMode->setRawValue(cameraMode);
        _setCameraMode(cameraMode);
    } else {
        //-- Use MAVLink Command
        _vehicle->sendMavCommand(
            _compID,                                // Target component
            MAV_CMD_SET_CAMERA_MODE,                // Command id
            true,                                   // ShowError
            0,                                      // Reserved (Set to 0)
            cameraMode);                            // Camera mode (0: photo, 1: video)
        _setCameraMode(cameraMode);
    }
}
 
void VehicleCameraControl::setPhotoCaptureMode(PhotoCaptureMode mode)
{
    if(!_resetting) {
        _photoCaptureMode = mode;
        QSettings settings;
        settings.setValue(kPhotoMode, static_cast<int>(mode));
        emit photoCaptureModeChanged();
    }
}
 
void VehicleCameraControl::setPhotoLapse(qreal interval)
{
    _photoLapse = interval;
    QSettings settings;
    settings.setValue(kPhotoLapse, interval);
    emit photoLapseChanged();
}
 
void VehicleCameraControl::setPhotoLapseCount(int count)
{
    _photoLapseCount = count;
    QSettings settings;
    settings.setValue(kPhotoLapseCount, count);
    emit photoLapseCountChanged();
}
 
void VehicleCameraControl::_setCameraMode(CameraMode mode)
{
    if(_cameraMode != mode) {
        _cameraMode = mode;
        emit cameraModeChanged();
        //-- Update stream status
        _streamStatusTimer.start(1000);
    }
}
 
void VehicleCameraControl::toggleCameraMode()
{
    if(!_resetting) {
        if(_cameraMode == CAM_MODE_PHOTO || _cameraMode == CAM_MODE_SURVEY) {
            setCameraModeVideo();
        } else if(_cameraMode == CAM_MODE_VIDEO) {
            setCameraModePhoto();
        }
    }
}
 
bool VehicleCameraControl::toggleVideoRecording()
{
    if(_resetting) {
        return false;
    }
 
    if (captureVideoState() == CaptureVideoStateCapturing) {
        return stopVideoRecording();
    } else {
        return startVideoRecording();
    }
 
    return false;
}
 
bool VehicleCameraControl::takePhoto()
{
    if (_resetting) {
        return false;
    }
    if (capturePhotosState() == CapturePhotosStateDisabled) {
        qCWarning(VehicleCameraControlLog) << "Take photo denied - photo capture is disabled";
        return false;
    }
    if (capturePhotosState() != CapturePhotosStateIdle) {
        qCWarning(VehicleCameraControlLog) << "Take photo denied - already capturing";
        return false;
    }
 
    qCDebug(VehicleCameraControlLog) << "takePhoto()";
 
    const bool canUseMavlinkImageCapture =
        (_mavlinkCameraInfo.flags & CAMERA_CAP_FLAGS_CAPTURE_IMAGE) &&
        (_cameraMode != CAM_MODE_VIDEO || photosInVideoMode());
 
    if (canUseMavlinkImageCapture) {
        _vehicle->sendMavCommand(
            _compID,
            MAV_CMD_IMAGE_START_CAPTURE,
            true,                           // ShowError
            0,                              // All cameras
            static_cast<float>(_photoCaptureMode == PHOTO_CAPTURE_SINGLE ? 0 : _photoLapse),   // Duration between two consecutive pictures (in seconds--ignored if single image)
            _photoCaptureMode == PHOTO_CAPTURE_SINGLE ? 1 : _photoLapseCount);                 // Number of images to capture total - 0 for unlimited capture
        _setPhotoCaptureStatus(PHOTO_CAPTURE_IN_PROGRESS);
        _captureInfoRetries = 0;
        return true;
    } else {
        if (_photoCaptureMode == PHOTO_CAPTURE_SINGLE) {
            VideoManager::instance()->grabImage();
            _setPhotoCaptureStatus(PHOTO_CAPTURE_IN_PROGRESS);
            QTimer::singleShot(500, this, [this]() {
                _setPhotoCaptureStatus(PHOTO_CAPTURE_IDLE);
            });
            return true;
        } else {
            QGC::showAppMessage(tr("Timelapse photo capture is not supported on cameras without still capture capability"));
        }
    }
 
    return false;
}
 
bool VehicleCameraControl::stopTakePhoto()
{
    if (_resetting) {
        return false;
    }
    if (capturePhotosState() != CapturePhotosStateCapturingMultiplePhotos) {
        qCWarning(VehicleCameraControlLog) << "Stop taking photos requested - not currently capturing multiple photos";
        return false;
    }
 
    qCDebug(VehicleCameraControlLog) << "Camera stop taking photos";
 
    // Interval capture is only supported directly by cameras
    _vehicle->sendMavCommand(
        _compID,                    // Target component
        MAV_CMD_IMAGE_STOP_CAPTURE,
        true,                       // ShowError
        0);                         // All cameras
    _setPhotoCaptureStatus(PHOTO_CAPTURE_IDLE);
    _captureInfoRetries = 0;
 
    return true;
}
 
bool VehicleCameraControl::startVideoRecording()
{
    if (_resetting) {
        return false;
    }
    if (captureVideoState() == CaptureVideoStateCapturing) {
        qCWarning(VehicleCameraControlLog) << "Start video denied - already recording";
        return false;
    }
    if (captureVideoState() == CaptureVideoStateDisabled) {
        qCWarning(VehicleCameraControlLog) << "Start video denied - video capture is disabled";
        return false;
    }
 
    bool useMavlinkCommand = _mavlinkCameraInfo.flags & CAMERA_CAP_FLAGS_CAPTURE_VIDEO;
 
    qCDebug(VehicleCameraControlLog) << "Start video recording:" << (useMavlinkCommand ? "MAVLink command" : "VideoManager");
 
    if (useMavlinkCommand) {
        _vehicle->sendMavCommand(
            _compID,                        // Target component
            MAV_CMD_VIDEO_START_CAPTURE,
            true,                           // Show error on failure
            0,                              // All streams
            0,                              // CAMERA_CAPTURE_STATUS streaming frequency
            0);                             // All cameras
    } else {
        VideoManager::instance()->startRecording();
    }
 
    return true;
}
 
bool VehicleCameraControl::stopVideoRecording()
{
    if (_resetting) {
        return false;
    }
    if (captureVideoState() == CaptureVideoStateIdle) {
        qCWarning(VehicleCameraControlLog) << "Stop video recording requested - already idle";
        return true;
    }
 
    bool useMavlinkCommand = _mavlinkCameraInfo.flags & CAMERA_CAP_FLAGS_CAPTURE_VIDEO;
 
    qCDebug(VehicleCameraControlLog) << "Camera stop video recording" << (useMavlinkCommand ? "MAVLink command" : "VideoManager");
 
    if (useMavlinkCommand) {
        _vehicle->sendMavCommand(
            _compID,                    // Target component
            MAV_CMD_VIDEO_STOP_CAPTURE,
            true,                       // Show error on failure
            0,                          // All streams
            0);                         // All cameras
    } else {
        VideoManager::instance()->stopRecording();
    }
 
    return true;
}
 
void VehicleCameraControl::setThermalMode(ThermalViewMode mode)
{
    QSettings settings;
    settings.setValue(kThermalMode, static_cast<uint32_t>(mode));
    _thermalMode = mode;
    emit thermalModeChanged();
}
 
void VehicleCameraControl::setThermalOpacity(double val)
{
    if(val < 0.0) val = 0.0;
    if(val > 100.0) val = 100.0;
    if(fabs(_thermalOpacity - val) > 0.1) {
        _thermalOpacity = val;
        QSettings settings;
        settings.setValue(kThermalOpacity, val);
        emit thermalOpacityChanged();
    }
}
 
void VehicleCameraControl::setZoomLevel(qreal level)
{
    qCDebug(VehicleCameraControlLog) << "Camera set zoom level to" << level;
    if(hasZoom()) {
        //-- Limit
        level = std::min(std::max(level, 0.0), 100.0);
        if(_vehicle) {
            _vehicle->sendMavCommand(
                _compID,                                // Target component
                MAV_CMD_SET_CAMERA_ZOOM,                // Command id
                false,                                  // ShowError
                ZOOM_TYPE_RANGE,                        // Zoom type
                static_cast<float>(level));             // Level
        }
    }
}
 
void VehicleCameraControl::setFocusLevel(qreal level)
{
    qCDebug(VehicleCameraControlLog) << "Camera set focus level to" << level;
    if(hasFocus()) {
        //-- Limit
        level = std::min(std::max(level, 0.0), 100.0);
        if(_vehicle) {
            _vehicle->sendMavCommand(
                _compID,                                // Target component
                MAV_CMD_SET_CAMERA_FOCUS,               // Command id
                false,                                  // ShowError
                FOCUS_TYPE_RANGE,                       // Focus type
                static_cast<float>(level));             // Level
        }
    }
}
 
void VehicleCameraControl::resetSettings()
{
    if(!_resetting) {
        qCDebug(VehicleCameraControlLog) << "resetSettings()";
        _resetting = true;
        _vehicle->sendMavCommand(
            _compID,                                // Target component
            MAV_CMD_RESET_CAMERA_SETTINGS,          // Command id
            true,                                   // ShowError
            1);                                     // Do Reset
    }
}
 
void VehicleCameraControl::formatCard(int id)
{
    if(!_resetting) {
        qCDebug(VehicleCameraControlLog) << "formatCard()";
        if(_vehicle) {
            _vehicle->sendMavCommand(
                _compID,                                // Target component
                MAV_CMD_STORAGE_FORMAT,                 // Command id
                true,                                   // ShowError
                id,                                     // Storage ID (1 for first, 2 for second, etc.)
                1);                                     // Do Format
        }
    }
}
 
void VehicleCameraControl::stepZoom(int direction)
{
    qCDebug(VehicleCameraControlLog) << "Camera step zoom" << direction;
    if(_vehicle && hasZoom()) {
        _vehicle->sendMavCommand(
            _compID,                                // Target component
            MAV_CMD_SET_CAMERA_ZOOM,                // Command id
            false,                                  // ShowError
            ZOOM_TYPE_STEP,                         // Zoom type
            direction);                             // Direction (-1 wide, 1 tele)
    }
}
 
void VehicleCameraControl::startZoom(int direction)
{
    qCDebug(VehicleCameraControlLog) << "Camera start zoom" << direction;
    if(_vehicle && hasZoom()) {
        _vehicle->sendMavCommand(
            _compID,                                // Target component
            MAV_CMD_SET_CAMERA_ZOOM,                // Command id
            false,                                  // ShowError
            ZOOM_TYPE_CONTINUOUS,                   // Zoom type
            direction);                             // Direction (-1 wide, 1 tele)
    }
}
 
void VehicleCameraControl::stopZoom()
{
    qCDebug(VehicleCameraControlLog) << "Camera stop zoom";
    if(_vehicle && hasZoom()) {
        _vehicle->sendMavCommand(
            _compID,                                // Target component
            MAV_CMD_SET_CAMERA_ZOOM,                // Command id
            false,                                  // ShowError
            ZOOM_TYPE_CONTINUOUS,                   // Zoom type
            0);                                     // Direction (-1 wide, 1 tele)
    }
}
 
void VehicleCameraControl::stepFocus(int direction)
{
    qCDebug(VehicleCameraControlLog) << "Camera step focus" << direction;
    if(_vehicle && hasFocus()) {
        _vehicle->sendMavCommand(
            _compID,                                // Target component
            MAV_CMD_SET_CAMERA_FOCUS,               // Command id
            false,                                  // ShowError
            FOCUS_TYPE_STEP,                        // Focus type
            direction);                             // Direction (-1 in, 1 out)
    }
}
 
void VehicleCameraControl::startFocus(int direction)
{
    qCDebug(VehicleCameraControlLog) << "Camera start focus" << direction;
    if(_vehicle && hasFocus()) {
        _vehicle->sendMavCommand(
            _compID,                                // Target component
            MAV_CMD_SET_CAMERA_FOCUS,               // Command id
            false,                                  // ShowError
            FOCUS_TYPE_CONTINUOUS,                  // Focus type
            direction);                             // Direction (-1 in, 1 out)
    }
}
 
void VehicleCameraControl::stopFocus()
{
    qCDebug(VehicleCameraControlLog) << "Camera stop focus";
    if(_vehicle && hasFocus()) {
        _vehicle->sendMavCommand(
            _compID,                                // Target component
            MAV_CMD_SET_CAMERA_FOCUS,               // Command id
            false,                                  // ShowError
            FOCUS_TYPE_CONTINUOUS,                  // Focus type
            0);                                     // Direction (-1 in, 1 out)
    }
}
 
void VehicleCameraControl::_requestCaptureStatus()
{
    qCDebug(VehicleCameraControlLog) << "Camera request capture status - retries:" << _cameraCaptureStatusRetries;
 
    if(_cameraCaptureStatusRetries++ % 2 == 0) {
        qCDebug(VehicleCameraControlLog) << "  Sending REQUEST_MESSAGE:MAVLINK_MSG_ID_CAMERA_CAPTURE_STATUS";
        _vehicle->sendMavCommand(
            _compID,                                // target component
            MAV_CMD_REQUEST_MESSAGE,                // command id
            false,                                  // showError
            MAVLINK_MSG_ID_CAMERA_CAPTURE_STATUS);  // msgid
    } else {
        qCDebug(VehicleCameraControlLog) << "  Sending MAV_CMD_REQUEST_CAMERA_CAPTURE_STATUS (legacy)";
        _vehicle->sendMavCommand(
            _compID,                                // target component
            MAV_CMD_REQUEST_CAMERA_CAPTURE_STATUS,  // command id
            false,                                  // showError
            1);                                     // Do Request
    }
}
 
void VehicleCameraControl::factChanged(Fact* pFact)
{
    _updateActiveList();
    _updateRanges(pFact);
}
 
void VehicleCameraControl::_mavCommandResult(int vehicleId, int component, int command, int result, int failureCode)
{
    Q_UNUSED(failureCode);
 
    //-- Is this ours?
    if (_vehicle->id() != vehicleId || compID() != component) {
        return;
    }
    if (result == MAV_RESULT_IN_PROGRESS) {
        //-- Do Nothing
        qCDebug(VehicleCameraControlLog) << "In progress response for" << command;
    } else if(result == MAV_RESULT_ACCEPTED) {
        switch(command) {
            case MAV_CMD_RESET_CAMERA_SETTINGS:
                _resetting = false;
                if(isBasic()) {
                    _requestCameraSettings();
                } else {
                    QTimer::singleShot(500, this, &VehicleCameraControl::_requestAllParameters);
                    QTimer::singleShot(2500, this, &VehicleCameraControl::_requestCameraSettings);
                }
                break;
            case MAV_CMD_VIDEO_START_CAPTURE:
                _setVideoCaptureStatus(VIDEO_CAPTURE_STATUS_RUNNING);
                _captureStatusTimer.start(1000);
                break;
            case MAV_CMD_VIDEO_STOP_CAPTURE:
                _setVideoCaptureStatus(VIDEO_CAPTURE_STATUS_STOPPED);
                _captureStatusTimer.start(1000);
                break;
            case MAV_CMD_REQUEST_CAMERA_CAPTURE_STATUS:
                _cameraCaptureStatusRetries = 0;
                break;
            case MAV_CMD_REQUEST_STORAGE_INFORMATION:
                _storageInfoRetries = 0;
                break;
            case MAV_CMD_IMAGE_START_CAPTURE:
                _captureStatusTimer.start(1000);
                break;
            case MAV_CMD_SET_CAMERA_ZOOM:
            case MAV_CMD_SET_CAMERA_FOCUS:
                _cameraSettingsRefreshTimer.start();
                break;
        }
    } else {
        QString commandStr = MissionCommandTree::instance()->rawName(static_cast<MAV_CMD>(command));
        if ((result == MAV_RESULT_TEMPORARILY_REJECTED) || (result == MAV_RESULT_FAILED)) {
            if (result == MAV_RESULT_TEMPORARILY_REJECTED) {
                qCDebug(VehicleCameraControlLog) << "Command temporarily rejected (MAV_RESULT_TEMPORARILY_REJECTED) for" << commandStr;
            } else {
                qCDebug(VehicleCameraControlLog) << "Command failed (MAV_RESULT_FAILED) for" << commandStr;
            }
            switch(command) {
                case MAV_CMD_RESET_CAMERA_SETTINGS:
                    _resetting = false;
                    qCDebug(VehicleCameraControlLog) << "Failed to reset camera settings";
                break;
                case MAV_CMD_IMAGE_START_CAPTURE:
                case MAV_CMD_IMAGE_STOP_CAPTURE:
                    if(++_captureInfoRetries <= 5) {
                        _captureStatusTimer.start(1000);
                    } else {
                        qCDebug(VehicleCameraControlLog) << "Giving up start/stop image capture";
                        _setPhotoCaptureStatus(PHOTO_CAPTURE_IDLE);
                    }
                    break;
                case MAV_CMD_REQUEST_CAMERA_CAPTURE_STATUS:
                    if(++_cameraCaptureStatusRetries <= 5) {
                        _captureStatusTimer.start(1000);
                    } else {
                        qCDebug(VehicleCameraControlLog) << "Giving up requesting capture status";
                    }
                    break;
                case MAV_CMD_REQUEST_STORAGE_INFORMATION:
                    if(++_storageInfoRetries <= 5) {
                        QTimer::singleShot(1000, this, &VehicleCameraControl::_requestStorageInfo);
                    } else {
                        qCDebug(VehicleCameraControlLog) << "Giving up requesting storage status";
                    }
                    break;
            }
        } else {
            qCDebug(VehicleCameraControlLog) << "Bad response for" << commandStr << QGCMAVLink::mavResultToString(result);
        }
    }
}
 
void VehicleCameraControl::_setVideoCaptureStatus(VideoCaptureStatus captureStatus)
{
    if(_videoCaptureStatusValue != captureStatus) {
        _videoCaptureStatusValue = captureStatus;
        emit videoCaptureStatusChanged();
        if(captureStatus == VIDEO_CAPTURE_STATUS_RUNNING) {
             _recordTime = 0;
             _recTime = QTime::currentTime();
             _videoRecordTimeUpdateTimer.start();
        } else {
             _videoRecordTimeUpdateTimer.stop();
             _recordTime = 0;
             emit recordTimeChanged();
        }
    }
}
 
void VehicleCameraControl::_recTimerHandler()
{
    _recordTime = static_cast<uint32_t>(_recTime.msecsTo(QTime::currentTime()));
    emit recordTimeChanged();
}
 
void VehicleCameraControl::_onVideoManagerRecordingChanged(bool recording)
{
    // Only track time here when not using MAVLink video capture (to avoid double-tracking)
    if (_videoCaptureStatus() == VIDEO_CAPTURE_STATUS_RUNNING) {
        return;
    }
 
    if (recording) {
        _recordTime = 0;
        _recTime = QTime::currentTime();
        _videoRecordTimeUpdateTimer.start();
    } else {
        _videoRecordTimeUpdateTimer.stop();
        _recordTime = 0;
        emit recordTimeChanged();
    }
}
 
void VehicleCameraControl::_setPhotoCaptureStatus(PhotoCaptureStatus captureStatus)
{
    if(_photoCaptureStatusValue != captureStatus) {
        qCDebug(VehicleCameraControlLog) << "Set Photo Status:" << captureStatus;
        _photoCaptureStatusValue = captureStatus;
        emit photoCaptureStatusChanged();
    }
}
 
bool VehicleCameraControl::_loadCameraDefinitionFile(QByteArray& bytes)
{
    QByteArray originalData(bytes);
    //-- Handle localization
    if(!_handleLocalization(bytes)) {
        return false;
    }
 
    QDomDocument doc;
    const QDomDocument::ParseResult result = doc.setContent(bytes, QDomDocument::ParseOption::Default);
    if (!result) {
        qCCritical(VehicleCameraControlLog) << "Unable to parse camera definition file on line:" << result.errorLine;
        qCCritical(VehicleCameraControlLog) << result.errorMessage;
        return false;
    }
    //-- Load camera constants
    QDomNodeList defElements = doc.elementsByTagName(kDefnition);
    if(!defElements.size() || !_loadConstants(defElements)) {
        qCWarning(VehicleCameraControlLog) <<  "Unable to load camera constants from camera definition";
        return false;
    }
    //-- Load camera parameters
    QDomNodeList paramElements = doc.elementsByTagName(kParameters);
    if(!paramElements.size()) {
        qCDebug(VehicleCameraControlLog) <<  "No parameters to load from camera";
        return false;
    }
    if(!_loadSettings(paramElements)) {
        qCWarning(VehicleCameraControlLog) <<  "Unable to load camera parameters from camera definition";
        return false;
    }
    //-- If this is new, cache it
    if(!_cached) {
        qCDebug(VehicleCameraControlLog) << "Saving camera definition file" << _cacheFile;
        QFile file(_cacheFile);
        if (!file.open(QIODevice::WriteOnly)) {
            qWarning() << QString("Could not save cache file %1. Error: %2").arg(_cacheFile).arg(file.errorString());
        } else {
            file.write(originalData);
        }
    }
    return true;
}
 
bool VehicleCameraControl::_loadConstants(const QDomNodeList nodeList)
{
    QDomNode node = nodeList.item(0);
    if(!read_attribute(node, kVersion, _version)) {
        return false;
    }
    if(!read_value(node, kModel, _modelName)) {
        return false;
    }
    if(!read_value(node, kVendor, _vendor)) {
        return false;
    }
    return true;
}
 
bool VehicleCameraControl::_loadSettings(const QDomNodeList nodeList)
{
    QDomNode node = nodeList.item(0);
    QDomElement elem = node.toElement();
    QDomNodeList parameters = elem.elementsByTagName(kParameter);
    //-- Pre-process settings (maintain order and skip non-controls)
    for(int i = 0; i < parameters.size(); i++) {
        QDomNode parameterNode = parameters.item(i);
        QString name;
        if(read_attribute(parameterNode, kName, name)) {
            bool control = true;
            read_attribute(parameterNode, kControl, control);
            if(control) {
                _settings << name;
            }
        } else {
            qCritical() << "Parameter entry missing parameter name";
            return false;
        }
    }
    //-- Load parameters
    for(int i = 0; i < parameters.size(); i++) {
        QDomNode parameterNode = parameters.item(i);
        QString factName;
        read_attribute(parameterNode, kName, factName);
        QString type;
        if(!read_attribute(parameterNode, kType, type)) {
            qCritical() << QString("Parameter %1 missing parameter type").arg(factName);
            return false;
        }
        //-- Does it have a control?
        bool control = true;
        read_attribute(parameterNode, kControl, control);
        //-- Is it read only?
        bool readOnly = false;
        read_attribute(parameterNode, kReadOnly, readOnly);
        //-- Is it write only?
        bool writeOnly = false;
        read_attribute(parameterNode, kWriteOnly, writeOnly);
        //-- It can't be both
        if(readOnly && writeOnly) {
            qCritical() << QString("Parameter %1 cannot be both read only and write only").arg(factName);
        }
        //-- Param type
        bool unknownType;
        FactMetaData::ValueType_t factType = FactMetaData::stringToType(type, unknownType);
        if (unknownType) {
            qCritical() << QString("Unknown type for parameter %1").arg(factName);
            return false;
        }
        //-- By definition, custom types do not have control
        if(factType == FactMetaData::valueTypeCustom) {
            control = false;
        }
        //-- Description
        QString description;
        if(!read_value(parameterNode, kDescription, description)) {
            qCritical() << QString("Parameter %1 missing parameter description").arg(factName);
            return false;
        }
        //-- Check for updates
        QStringList updates = _loadUpdates(parameterNode);
        if(updates.size()) {
            qCDebug(VehicleCameraControlVerboseLog) << "Parameter" << factName << "requires updates for:" << updates;
            _requestUpdates[factName] = updates;
        }
        //-- Build metadata
        FactMetaData* metaData = new FactMetaData(factType, factName, this);
        QQmlEngine::setObjectOwnership(metaData, QQmlEngine::CppOwnership);
        metaData->setShortDescription(description);
        metaData->setLongDescription(description);
        metaData->setHasControl(control);
        metaData->setReadOnly(readOnly);
        metaData->setWriteOnly(writeOnly);
        //-- Options (enums)
        QDomElement optionElem = parameterNode.toElement();
        QDomNodeList optionsRoot = optionElem.elementsByTagName(kOptions);
        if(optionsRoot.size()) {
            //-- Iterate options
            QDomNode optionsNode = optionsRoot.item(0);
            QDomElement optionsElem = optionsNode.toElement();
            QDomNodeList options = optionsElem.elementsByTagName(kOption);
            for(int optionIndex = 0; optionIndex < options.size(); optionIndex++) {
                QDomNode option = options.item(optionIndex);
                QString optName;
                QString optValue;
                QVariant optVariant;
                if(!_loadNameValue(option, factName, metaData, optName, optValue, optVariant)) {
                    delete metaData;
                    return false;
                }
                metaData->addEnumInfo(optName, optVariant);
                _originalOptNames[factName]  << optName;
                _originalOptValues[factName] << optVariant;
                //-- Check for exclusions
                QStringList exclusions = _loadExclusions(option);
                if(exclusions.size()) {
                    qCDebug(VehicleCameraControlVerboseLog) << "New exclusions:" << factName << optValue << exclusions;
                    QGCCameraOptionExclusion* pExc = new QGCCameraOptionExclusion(this, factName, optValue, exclusions);
                    QQmlEngine::setObjectOwnership(pExc, QQmlEngine::CppOwnership);
                    _valueExclusions.append(pExc);
                }
                //-- Check for range rules
                if(!_loadRanges(option, factName, optValue)) {
                    delete metaData;
                    return false;
                }
            }
        }
        QString defaultValue;
        if(read_attribute(parameterNode, kDefault, defaultValue)) {
            QVariant defaultVariant;
            QString  errorString;
            if (metaData->convertAndValidateRaw(defaultValue, false, defaultVariant, errorString)) {
                metaData->setRawDefaultValue(defaultVariant);
            } else {
                qWarning() << "Invalid default value for" << factName
                           << " type:"  << metaData->type()
                           << " value:" << defaultValue
                           << " error:" << errorString;
            }
        }
        //-- Set metadata and Fact
        if (_nameToFactMetaDataMap.contains(factName)) {
            qWarning() << QStringLiteral("Duplicate fact name:") << factName;
            delete metaData;
        } else {
            {
                //-- Check for Min Value
                QString attr;
                if(read_attribute(parameterNode, kMin, attr)) {
                    QVariant typedValue;
                    QString  errorString;
                    if (metaData->convertAndValidateRaw(attr, true /* convertOnly */, typedValue, errorString)) {
                        metaData->setRawMin(typedValue);
                    } else {
                        qWarning() << "Invalid min value for" << factName
                                   << " type:"  << metaData->type()
                                   << " value:" << attr
                                   << " error:" << errorString;
                    }
                }
            }
            {
                //-- Check for Max Value
                QString attr;
                if(read_attribute(parameterNode, kMax, attr)) {
                    QVariant typedValue;
                    QString  errorString;
                    if (metaData->convertAndValidateRaw(attr, true /* convertOnly */, typedValue, errorString)) {
                        metaData->setRawMax(typedValue);
                    } else {
                        qWarning() << "Invalid max value for" << factName
                                   << " type:"  << metaData->type()
                                   << " value:" << attr
                                   << " error:" << errorString;
                    }
                }
            }
            {
                //-- Check for Step Value
                QString attr;
                if(read_attribute(parameterNode, kStep, attr)) {
                    QVariant typedValue;
                    QString  errorString;
                    if (metaData->convertAndValidateRaw(attr, true /* convertOnly */, typedValue, errorString)) {
                        metaData->setRawIncrement(typedValue.toDouble());
                    } else {
                        qWarning() << "Invalid step value for" << factName
                                   << " type:"  << metaData->type()
                                   << " value:" << attr
                                   << " error:" << errorString;
                    }
                }
            }
            {
                //-- Check for Decimal Places
                QString attr;
                if(read_attribute(parameterNode, kDecimalPlaces, attr)) {
                    QVariant typedValue;
                    QString  errorString;
                    if (metaData->convertAndValidateRaw(attr, true /* convertOnly */, typedValue, errorString)) {
                        metaData->setDecimalPlaces(typedValue.toInt());
                    } else {
                        qWarning() << "Invalid decimal places value for" << factName
                                   << " type:"  << metaData->type()
                                   << " value:" << attr
                                   << " error:" << errorString;
                    }
                }
            }
            {
                //-- Check for Units
                QString attr;
                if(read_attribute(parameterNode, kUnit, attr)) {
                    metaData->setRawUnits(attr);
                }
            }
            qCDebug(VehicleCameraControlLog) << "New parameter:" << factName << (readOnly ? "ReadOnly" : "Writable") << (writeOnly ? "WriteOnly" : "Readable");
            _nameToFactMetaDataMap[factName] = metaData;
            Fact* pFact = new Fact(_compID, factName, factType, this);
            QQmlEngine::setObjectOwnership(pFact, QQmlEngine::CppOwnership);
            pFact->setMetaData(metaData);
            pFact->containerSetRawValue(metaData->rawDefaultValue());
            QGCCameraParamIO* pIO = new QGCCameraParamIO(this, pFact, _vehicle);
            QQmlEngine::setObjectOwnership(pIO, QQmlEngine::CppOwnership);
            _paramIO[factName] = pIO;
            _addFact(pFact, factName);
        }
    }
    if(_nameToFactMetaDataMap.size() > 0) {
        _addFactGroup(this, "camera");
        _processRanges();
        _activeSettings = _settings;
        emit activeSettingsChanged();
        return true;
    }
    return false;
}
 
bool VehicleCameraControl::_handleLocalization(QByteArray& bytes)
{
    QDomDocument doc;
    const QDomDocument::ParseResult result = doc.setContent(bytes, QDomDocument::ParseOption::Default);
    if (!result) {
        qCritical() << "Unable to parse camera definition file on line:" << result.errorLine;
        qCritical() << result.errorMessage;
        return false;
    }
    //-- Find out where we are
    QLocale locale = QLocale::system();
#if defined (Q_OS_MACOS)
    locale = QLocale(locale.name());
#endif
    QString localeName = locale.name().toLower().replace("-", "_");
    qCDebug(VehicleCameraControlLog) << "Current locale:" << localeName;
    if(localeName == "en_us") {
        // Nothing to do
        return true;
    }
    QDomNodeList locRoot = doc.elementsByTagName(kLocalization);
    if(!locRoot.size()) {
        // Nothing to do
        return true;
    }
    //-- Iterate locales
    QDomNode node = locRoot.item(0);
    QDomElement elem = node.toElement();
    QDomNodeList locales = elem.elementsByTagName(kLocale);
    for(int i = 0; i < locales.size(); i++) {
        QDomNode localeNode = locales.item(i);
        QString name;
        if(!read_attribute(localeNode, kName, name)) {
            qWarning() << "Localization entry is missing its name attribute";
            continue;
        }
        // If we found a direct match, deal with it now
        if(localeName == name.toLower().replace("-", "_")) {
            return _replaceLocaleStrings(localeNode, bytes);
        }
    }
    //-- No direct match. Pick first matching language (if any)
    localeName = localeName.left(3);
    for(int i = 0; i < locales.size(); i++) {
        QDomNode localeNode = locales.item(i);
        QString name;
        read_attribute(localeNode, kName, name);
        if(name.toLower().startsWith(localeName)) {
            return _replaceLocaleStrings(localeNode, bytes);
        }
    }
    //-- Could not find a language to use
    qWarning() <<  "No match for" << QLocale::system().name() << "in camera definition file";
    //-- Just use default, en_US
    return true;
}
 
bool VehicleCameraControl::_replaceLocaleStrings(const QDomNode node, QByteArray& bytes)
{
    QDomElement stringElem = node.toElement();
    QDomNodeList strings = stringElem.elementsByTagName(kStrings);
    for(int i = 0; i < strings.size(); i++) {
        QDomNode stringNode = strings.item(i);
        QString original;
        QString translated;
        if(read_attribute(stringNode, kOriginal, original)) {
            if(read_attribute(stringNode, kTranslated, translated)) {
                QString o; o = "\"" + original + "\"";
                QString t; t = "\"" + translated + "\"";
                bytes.replace(o.toUtf8(), t.toUtf8());
                o = ">" + original + "<";
                t = ">" + translated + "<";
                bytes.replace(o.toUtf8(), t.toUtf8());
            }
        }
    }
    return true;
}
 
void VehicleCameraControl::_requestAllParameters()
{
    //-- Reset receive list
    for(const QString& paramName: _paramIO.keys()) {
        if(_paramIO[paramName]) {
            _paramIO[paramName]->setParamRequest();
        } else {
            qCritical() << "QGCParamIO is NULL" << paramName;
        }
    }
    SharedLinkInterfacePtr sharedLink = _vehicle->vehicleLinkManager()->primaryLink().lock();
    if (sharedLink) {
        mavlink_message_t msg;
        mavlink_msg_param_ext_request_list_pack_chan(
                    static_cast<uint8_t>(MAVLinkProtocol::instance()->getSystemId()),
                    static_cast<uint8_t>(MAVLinkProtocol::getComponentId()),
                    sharedLink->mavlinkChannel(),
                    &msg,
                    static_cast<uint8_t>(_vehicle->id()),
                    static_cast<uint8_t>(compID()));
        _vehicle->sendMessageOnLinkThreadSafe(sharedLink.get(), msg);
    }
    qCDebug(VehicleCameraControlVerboseLog) << "Request all parameters";
}
 
QString VehicleCameraControl::_getParamName(const char* param_id)
{
    // This will null terminate the name string
    char parameterNameWithNull[MAVLINK_MSG_PARAM_VALUE_FIELD_PARAM_ID_LEN + 1] = {};
    (void) strncpy(parameterNameWithNull, param_id, MAVLINK_MSG_PARAM_VALUE_FIELD_PARAM_ID_LEN);
    const QString parameterName(parameterNameWithNull);
    return parameterName;
}
 
void VehicleCameraControl::handleParamExtAck(const mavlink_param_ext_ack_t& paramExtAck)
{
    QString paramName = _getParamName(paramExtAck.param_id);
    qCDebug(VehicleCameraControlLog).noquote() << "Received PARAM_EXT_ACK:"
        << "\n\tParam name:" << paramName
        << "\n\tResult:" << static_cast<int>(paramExtAck.param_result)
        << "\n\tType:" << static_cast<int>(paramExtAck.param_type);
 
    if(!_paramIO.contains(paramName)) {
        qCWarning(VehicleCameraControlLog) << "Received PARAM_EXT_ACK for unknown param:" << paramName;
        return;
    }
    if(_paramIO[paramName]) {
        _paramIO[paramName]->handleParamAck(paramExtAck);
    } else {
        qCritical() << "QGCParamIO is NULL" << paramName;
    }
}
 
void VehicleCameraControl::handleParamExtValue(const mavlink_param_ext_value_t& paramExtValue)
{
    QString paramName = _getParamName(paramExtValue.param_id);
    qCDebug(VehicleCameraControlLog).noquote() << "Received PARAM_EXT_VALUE:"
        << "\n\tParam name:" << paramName
        << "\n\tType:" << static_cast<int>(paramExtValue.param_type)
        << "\n\tIndex:" << static_cast<int>(paramExtValue.param_index)
        << "\n\tCount:" << static_cast<int>(paramExtValue.param_count);
 
    if(!_paramIO.contains(paramName)) {
        qCWarning(VehicleCameraControlLog) << "Received PARAM_EXT_VALUE for unknown param:" << paramName;
        return;
    }
    if(_paramIO[paramName]) {
        _paramIO[paramName]->handleParamValue(paramExtValue);
    } else {
        qCritical() << "QGCParamIO is NULL" << paramName;
    }
}
 
void VehicleCameraControl::_updateActiveList()
{
    //-- Clear out excluded parameters based on exclusion rules
    QStringList exclusionList;
    for(QGCCameraOptionExclusion* param: _valueExclusions) {
        Fact* pFact = getFact(param->param);
        if(pFact) {
            QString option = pFact->rawValueString();
            if(param->value == option) {
                exclusionList << param->exclusions;
            }
        }
    }
    QStringList active;
    for(QString key: _settings) {
        if(!exclusionList.contains(key)) {
            active.append(key);
        }
    }
    if(active != _activeSettings) {
        qCDebug(VehicleCameraControlVerboseLog) << "Excluding" << exclusionList;
        _activeSettings = active;
        emit activeSettingsChanged();
        //-- Force validity of "Facts" based on active set
        if(_paramComplete) {
            emit parametersReady();
        }
    }
}
 
bool VehicleCameraControl::_processConditionTest(const QString conditionTest)
{
    enum {
        TEST_NONE,
        TEST_EQUAL,
        TEST_NOT_EQUAL,
        TEST_GREATER,
        TEST_SMALLER
    };
    qCDebug(VehicleCameraControlVerboseLog) << "_processConditionTest(" << conditionTest << ")";
    int op = TEST_NONE;
    QStringList test;
 
    auto split = [&conditionTest](const QString& sep ) {
        return conditionTest.split(sep, Qt::SkipEmptyParts);
    };
 
    if(conditionTest.contains("!=")) {
        test = split("!=");
        op = TEST_NOT_EQUAL;
    } else if(conditionTest.contains("=")) {
        test = split("=");
        op = TEST_EQUAL;
    } else if(conditionTest.contains(">")) {
        test = split(">");
        op = TEST_GREATER;
    } else if(conditionTest.contains("<")) {
        test = split("<");
        op = TEST_SMALLER;
    }
    if(test.size() == 2) {
        Fact* pFact = getFact(test[0]);
        if(pFact) {
            switch(op) {
            case TEST_EQUAL:
                return pFact->rawValueString() == test[1];
            case TEST_NOT_EQUAL:
                return pFact->rawValueString() != test[1];
            case TEST_GREATER:
                return pFact->rawValueString() > test[1];
            case TEST_SMALLER:
                return pFact->rawValueString() < test[1];
            case TEST_NONE:
                break;
            }
        } else {
            qWarning() << "Invalid condition parameter:" << test[0] << "in" << conditionTest;
            return false;
        }
    }
    qWarning() << "Invalid condition" << conditionTest;
    return false;
}
 
bool VehicleCameraControl::_processCondition(const QString condition)
{
    qCDebug(VehicleCameraControlVerboseLog) << "_processCondition(" << condition << ")";
    bool result = true;
    bool andOp  = true;
    if(!condition.isEmpty()) {
        QStringList scond = condition.split(" ", Qt::SkipEmptyParts);
        while(scond.size()) {
            QString test = scond.first();
            scond.removeFirst();
            if(andOp) {
                result = result && _processConditionTest(test);
            } else {
                result = result || _processConditionTest(test);
            }
            if(!scond.size()) {
                return result;
            }
            andOp = scond.first().toUpper() == "AND";
            scond.removeFirst();
        }
    }
    return result;
}
 
void VehicleCameraControl::_updateRanges(Fact* pFact)
{
    QMap<Fact*, QGCCameraOptionRange*> rangesSet;
    QMap<Fact*, QString> rangesReset;
    QStringList changedList;
    QStringList resetList;
    QStringList updates;
    //-- Iterate range sets looking for limited ranges
    for(QGCCameraOptionRange* pRange: _optionRanges) {
        //-- If this fact or one of its conditions is part of this range set
        if(!changedList.contains(pRange->targetParam) && (pRange->param == pFact->name() || pRange->condition.contains(pFact->name()))) {
            Fact* pRFact = getFact(pRange->param);          //-- This parameter
            Fact* pTFact = getFact(pRange->targetParam);    //-- The target parameter (the one its range is to change)
            if(pRFact && pTFact) {
                //qCDebug(VehicleCameraControlVerboseLog) << "Check new set of options for" << pTFact->name();
                QString option = pRFact->rawValueString();  //-- This parameter value
                //-- If this value (and condition) triggers a change in the target range
                //qCDebug(VehicleCameraControlVerboseLog) << "Range value:" << pRange->value << "Current value:" << option << "Condition:" << pRange->condition;
                if(pRange->value == option && _processCondition(pRange->condition)) {
                    if(pTFact->enumStrings() != pRange->optNames) {
                        //-- Set limited range set
                        rangesSet[pTFact] = pRange;
                    }
                    changedList << pRange->targetParam;
                }
            }
        }
    }
    //-- Iterate range sets again looking for resets
    for(QGCCameraOptionRange* pRange: _optionRanges) {
        if(!changedList.contains(pRange->targetParam) && (pRange->param == pFact->name() || pRange->condition.contains(pFact->name()))) {
            Fact* pTFact = getFact(pRange->targetParam);    //-- The target parameter (the one its range is to change)
            if(!resetList.contains(pRange->targetParam)) {
                if(pTFact->enumStrings() != _originalOptNames[pRange->targetParam]) {
                    //-- Restore full option set
                    rangesReset[pTFact] = pRange->targetParam;
                }
                resetList << pRange->targetParam;
            }
        }
    }
    //-- Update limited range set
    for (Fact* f: rangesSet.keys()) {
        f->setEnumInfo(rangesSet[f]->optNames, rangesSet[f]->optVariants);
        if(!updates.contains(f->name())) {
            emit f->enumsChanged();
            qCDebug(VehicleCameraControlVerboseLog) << "Limited set of options for:" << f->name() << rangesSet[f]->optNames;;
            updates << f->name();
        }
    }
    //-- Restore full range set
    for (Fact* f: rangesReset.keys()) {
        f->setEnumInfo(_originalOptNames[rangesReset[f]], _originalOptValues[rangesReset[f]]);
        if(!updates.contains(f->name())) {
            emit f->enumsChanged();
            qCDebug(VehicleCameraControlVerboseLog) << "Restore full set of options for:" << f->name() << _originalOptNames[f->name()];
            updates << f->name();
        }
    }
    //-- Parameter update requests
    if(_requestUpdates.contains(pFact->name())) {
        for(const QString& param: _requestUpdates[pFact->name()]) {
            if(!_updatesToRequest.contains(param)) {
                _updatesToRequest << param;
            }
        }
    }
    if(_updatesToRequest.size()) {
        QTimer::singleShot(500, this, &VehicleCameraControl::_requestParamUpdates);
    }
}
 
void VehicleCameraControl::_requestParamUpdates()
{
    for(const QString& param: _updatesToRequest) {
        _paramIO[param]->paramRequest();
    }
    _updatesToRequest.clear();
}
 
void VehicleCameraControl::_requestCameraSettings()
{
    qCDebug(VehicleCameraControlLog) << "_requestCameraSettings() - retries:" << _cameraSettingsRetries << "timer active:" << _cameraSettingsTimer.isActive();
    if(_vehicle) {
        // Use REQUEST_MESSAGE instead of deprecated REQUEST_CAMERA_SETTINGS
        // first time and every other time after that.
 
        if(_cameraSettingsRetries % 2 == 0) {
            qCDebug(VehicleCameraControlLog) << "  Sending REQUEST_MESSAGE:MAVLINK_MSG_ID_CAMERA_SETTINGS";
            _vehicle->sendMavCommand(
                _compID,                                 // target component
                MAV_CMD_REQUEST_MESSAGE,                // command id
                false,                                  // showError
                MAVLINK_MSG_ID_CAMERA_SETTINGS);        // msgid
        } else {
            qCDebug(VehicleCameraControlLog) << "  Sending MAV_CMD_REQUEST_CAMERA_SETTINGS (legacy)";
            _vehicle->sendMavCommand(
                _compID,                                // Target component
                MAV_CMD_REQUEST_CAMERA_SETTINGS,        // command id
                false,                                  // showError
                1);                                     // Do Request
        }
        if(_cameraSettingsTimer.isActive()) {
            qCDebug(VehicleCameraControlLog) << "_requestCameraSettings() - RESTARTING already active timer";
        } else {
            qCDebug(VehicleCameraControlLog) << "_requestCameraSettings() - starting timer";
        }
        _cameraSettingsTimer.start(1000);               // Wait up to a second for it
    }
 
}
 
void VehicleCameraControl::_requestStorageInfo()
{
    qCDebug(VehicleCameraControlLog) << "_requestStorageInfo() - retries:" << _storageInfoRetries << "timer active:" << _storageInfoTimer.isActive();
    if(_vehicle) {
        // Use REQUEST_MESSAGE instead of deprecated REQUEST_STORAGE_INFORMATION
        // first time and every other time after that.
        if(_storageInfoRetries % 2 == 0) {
            qCDebug(VehicleCameraControlLog) << "  Sending REQUEST_MESSAGE:MAVLINK_MSG_ID_STORAGE_INFORMATION";
            _vehicle->sendMavCommand(
                _compID,                                 // target component
                MAV_CMD_REQUEST_MESSAGE,                // command id
                false,                                  // showError
                MAVLINK_MSG_ID_STORAGE_INFORMATION,     // msgid
                0);                                     // storage ID
        } else {
            qCDebug(VehicleCameraControlLog) << "  Sending MAV_CMD_REQUEST_STORAGE_INFORMATION (legacy)";
            _vehicle->sendMavCommand(
                _compID,                                // Target component
                MAV_CMD_REQUEST_STORAGE_INFORMATION,    // command id
                false,                                  // showError
                0,                                      // Storage ID (0 for all, 1 for first, 2 for second, etc.)
                1);                                     // Do Request
        }
        qCDebug(VehicleCameraControlLog) << "_requestStorageInfo() - starting timer";
        _storageInfoTimer.start(1000);                  // Wait up to a second for it
    }
}
 
void VehicleCameraControl::handleCameraSettings(const mavlink_camera_settings_t& settings)
{
    qCDebug(VehicleCameraControlLog).noquote() << "Received CAMERA_SETTINGS - stopping timer, resetting retries:"
        << "\n\tMode:" << settings.mode_id
        << "\n\tZoom level:" << settings.zoomLevel
        << "\n\tFocus level:" << settings.focusLevel;
 
    _cameraSettingsTimer.stop();
    _cameraSettingsRetries = 0;
 
    _setCameraMode(static_cast<CameraMode>(settings.mode_id));
    qreal z = static_cast<qreal>(settings.zoomLevel);
    qreal f = static_cast<qreal>(settings.focusLevel);
    if(std::isfinite(z) && z != _zoomLevel) {
        _zoomLevel = z;
        emit zoomLevelChanged();
    }
    if(std::isfinite(f) && f != _focusLevel) {
        _focusLevel = f;
        emit focusLevelChanged();
    }
}
 
void VehicleCameraControl::handleStorageInformation(const mavlink_storage_information_t& storageInformation)
{
    qCDebug(VehicleCameraControlLog) << "Received STORAGE_INFORMATION - stopping timer, resetting retries:"
        << "\n\tStorage id:" << storageInformation.storage_id
        << "\n\tStorage count:" << storageInformation.storage_count
        << "\n\tStatus:"<< storageStatusToStr(storageInformation.status)
        << "\n\tTotal capacity:" << storageInformation.total_capacity
        << "\n\tUsed capacity:" << storageInformation.used_capacity
        << "\n\tAvailable capacity:" << storageInformation.available_capacity;
 
        _storageInfoTimer.stop();
    _storageInfoRetries = 0;
 
    if(storageInformation.status == STORAGE_STATUS_READY) {
        uint32_t t = static_cast<uint32_t>(storageInformation.total_capacity);
        if(_storageTotal != t) {
            _storageTotal = t;
            emit storageTotalChanged();
        }
        uint32_t a = static_cast<uint32_t>(storageInformation.available_capacity);
        if(_storageFree != a) {
            _storageFree = a;
            emit storageFreeChanged();
        }
    }
    if(_storageStatus != static_cast<StorageStatus>(storageInformation.status)) {
        _storageStatus = static_cast<StorageStatus>(storageInformation.status);
        emit storageStatusChanged();
    }
}
 
void VehicleCameraControl::handleBatteryStatus(const mavlink_battery_status_t& bs)
{
    qCDebug(VehicleCameraControlLog).noquote() << "Received BATTERY_STATUS:"
        << "\n\tBattery remaining (%):" << bs.battery_remaining;
 
    if(bs.battery_remaining >= 0 && _batteryRemaining != static_cast<int>(bs.battery_remaining)) {
        _batteryRemaining = static_cast<int>(bs.battery_remaining);
        emit batteryRemainingChanged();
    }
}
 
void VehicleCameraControl::handleCameraCaptureStatus(const mavlink_camera_capture_status_t& cameraCaptureStatus)
{
    qCDebug(VehicleCameraControlLog).noquote() << "Received CAMERA_CAPTURE_STATUS - stopping timer, resetting retries:"
        << "\n\tImage status:" << captureImageStatusToStr(cameraCaptureStatus.image_status)
        << "\n\tVideo status:" << captureVideoStatusToStr(cameraCaptureStatus.video_status)
        << "\n\tInterval:" << cameraCaptureStatus.image_interval
        << "\n\tRecording time (ms):" << cameraCaptureStatus.recording_time_ms
        << "\n\tCapacity:" << cameraCaptureStatus.available_capacity;
 
    _captureStatusTimer.stop();
    _cameraCaptureStatusRetries = 0;
 
    //-- Disk Free Space
    uint32_t a = static_cast<uint32_t>(cameraCaptureStatus.available_capacity);
    if(_storageFree != a) {
        _storageFree = a;
        emit storageFreeChanged();
    }
    //-- Do we have recording time?
    if(cameraCaptureStatus.recording_time_ms) {
        // Resync our _recTime timer to the time info received from the camera component
        _recordTime = cameraCaptureStatus.recording_time_ms;
        _recTime = _recTime.addMSecs(_recTime.msecsTo(QTime::currentTime()) - static_cast<int>(cameraCaptureStatus.recording_time_ms));
        emit recordTimeChanged();
    }
    //-- Video/Image Capture Status
    uint8_t vs = cameraCaptureStatus.video_status < static_cast<uint8_t>(VIDEO_CAPTURE_STATUS_LAST) ? cameraCaptureStatus.video_status : static_cast<uint8_t>(VIDEO_CAPTURE_STATUS_UNDEFINED);
    uint8_t ps = cameraCaptureStatus.image_status < static_cast<uint8_t>(PHOTO_CAPTURE_LAST) ? cameraCaptureStatus.image_status : static_cast<uint8_t>(PHOTO_CAPTURE_STATUS_UNDEFINED);
    _setVideoCaptureStatus(static_cast<VideoCaptureStatus>(vs));
    _setPhotoCaptureStatus(static_cast<PhotoCaptureStatus>(ps));
    //-- Keep asking for it once in a while when recording
    if(_videoCaptureStatus() == VIDEO_CAPTURE_STATUS_RUNNING) {
        _captureStatusTimer.start(5000);
    //-- Same while (single) image capture is busy
    } else if(_photoCaptureStatus() != PHOTO_CAPTURE_IDLE && photoCaptureMode() == PHOTO_CAPTURE_SINGLE) {
        _captureStatusTimer.start(1000);
    }
    //-- Time Lapse
    if(_photoCaptureStatus() == PHOTO_CAPTURE_INTERVAL_IDLE || _photoCaptureStatus() == PHOTO_CAPTURE_INTERVAL_IN_PROGRESS) {
        //-- Capture local image as well
        const QString photoDir = SettingsManager::instance()->appSettings()->savePath()->rawValue().toString() + QStringLiteral("/Photo");
        QGCFileHelper::ensureDirectoryExists(photoDir);
        const QString photoPath = photoDir + "/" + QDateTime::currentDateTime().toString("yyyy-MM-dd_hh.mm.ss.zzz") + ".jpg";
        VideoManager::instance()->grabImage(photoPath);
    }
}
 
void VehicleCameraControl::handleVideoStreamInformation(const mavlink_video_stream_information_t& videoStreamInformation)
{
    qCDebug(VehicleCameraControlLog).noquote() << "Received VIDEO_STREAM_INFORMATION:"
        << "\n\tStream ID:" << videoStreamInformation.stream_id
        << "\n\tStream count:" << videoStreamInformation.count
        << "\n\tType:" << static_cast<int>(videoStreamInformation.type)
        << "\n\tFlags:" << Qt::hex << Qt::showbase << videoStreamInformation.flags << Qt::dec << Qt::noshowbase
        << "\n\tBitrate (bits/s):" << videoStreamInformation.bitrate
        << "\n\tFramerate (fps):" << videoStreamInformation.framerate
        << "\n\tResolution:" << videoStreamInformation.resolution_h << "x" << videoStreamInformation.resolution_v
        << "\n\tRotation (deg):" << videoStreamInformation.rotation
        << "\n\tHFOV (deg):" << videoStreamInformation.hfov
        << "\n\tURI:" << videoStreamInformation.uri;
 
    _expectedCount = videoStreamInformation.count;
    if(!_findStream(videoStreamInformation.stream_id, false)) {
        qCDebug(VehicleCameraControlLog) << "Create stream handler for stream ID:" << videoStreamInformation.stream_id;
        QGCVideoStreamInfo* pStream = new QGCVideoStreamInfo(videoStreamInformation, this);
        QQmlEngine::setObjectOwnership(pStream, QQmlEngine::CppOwnership);
        _streams.append(pStream);
        //-- Thermal is handled separately and not listed
        if(!pStream->isThermal()) {
            _streamLabels.append(pStream->name());
            emit streamsChanged();
            emit streamLabelsChanged();
        } else {
            emit thermalStreamChanged();
        }
    }
    //-- Check for missing count
    if(_streams.count() < _expectedCount) {
        _streamInfoTimer.start(1000);
    } else if (_streamInfoTimer.isActive()) {
        //-- Done
        qCDebug(VehicleCameraControlLog) << "All stream handlers done";
        _streamInfoTimer.stop();
        _videoStreamInfoRetries = 0;
        emit autoStreamChanged();
        emit _vehicle->cameraManager()->streamChanged();
    }
}
 
void VehicleCameraControl::handleVideoStreamStatus(const mavlink_video_stream_status_t& videoStreamStatus)
{
    qCDebug(VehicleCameraControlLog) << "Received VIDEO_STREAM_STATUS - stopping timer, resetting retries:"
        << "\n\tStream ID:" << videoStreamStatus.stream_id
        << "\n\tFlags:" << Qt::hex << Qt::showbase << videoStreamStatus.flags << Qt::dec << Qt::noshowbase
        << "\n\tBitrate (bits/s):" << videoStreamStatus.bitrate
        << "\n\tFramerate (fps):" << videoStreamStatus.framerate
        << "\n\tResolution: " << videoStreamStatus.resolution_h << "x" << videoStreamStatus.resolution_v
        << "\n\tRotation (deg):" << videoStreamStatus.rotation
        << "\n\tHFOV (deg):" << videoStreamStatus.hfov;
 
    _streamStatusTimer.stop();
    _videoStreamStatusRetries = 0;
 
    QGCVideoStreamInfo* pInfo = _findStream(videoStreamStatus.stream_id);
    if(pInfo) {
        pInfo->update(videoStreamStatus);
    }
}
 
void VehicleCameraControl::handleTrackingImageStatus(const mavlink_camera_tracking_image_status_t& trackingImageStatus)
{
    qCDebug(VehicleCameraControlLog).noquote() << "Received CAMERA_TRACKING_IMAGE_STATUS:"
        << "\n\tTracking status:" << static_cast<int>(trackingImageStatus.tracking_status)
        << "\n\tTracking mode:" << static_cast<int>(trackingImageStatus.tracking_mode)
        << "\n\tPoint:" << trackingImageStatus.point_x << "," << trackingImageStatus.point_y
        << "\n\tRectangle:" << trackingImageStatus.rec_top_x << "," << trackingImageStatus.rec_top_y
        << " -> " << trackingImageStatus.rec_bottom_x << "," << trackingImageStatus.rec_bottom_y
        << "\n\tRadius:" << trackingImageStatus.radius;
 
    _trackingImageStatus = trackingImageStatus;
 
    const bool active = ((_trackingImageStatus.tracking_status & CAMERA_TRACKING_STATUS_FLAGS_ACTIVE) != 0) && trackingEnabled();
    const bool isPoint = active && (_trackingImageStatus.tracking_mode == CAMERA_TRACKING_MODE_POINT);
 
    if (!active) {
        qCDebug(VehicleCameraControlLog) << "Tracking off";
        _trackingImageRect = {};
        _trackingImagePoint = {};
        _trackingImageRadius = 0.0;
    } else if (isPoint) {
        const QPointF point(std::clamp(static_cast<qreal>(_trackingImageStatus.point_x), 0.0, 1.0),
                              std::clamp(static_cast<qreal>(_trackingImageStatus.point_y), 0.0, 1.0));
        qreal radius = static_cast<qreal>(_trackingImageStatus.radius);
        if (qIsNaN(radius) || radius <= 0) {
            radius = 0.05;
        } else {
            radius = std::clamp(radius, 0.0, 1.0);
        }
        qCDebug(VehicleCameraControlLog) << "Tracking Point [" << point << "] radius:" << radius;
        _trackingImageRect = {};
        if (_trackingImagePoint != point) {
            _trackingImagePoint = point;
            emit trackingImagePointChanged();
        }
        if (!qFuzzyCompare(_trackingImageRadius, radius)) {
            _trackingImageRadius = radius;
            emit trackingImageRadiusChanged();
        }
    } else {
        // Rectangle tracking
        const QRectF rect = QRectF(QPointF(std::clamp(static_cast<qreal>(_trackingImageStatus.rec_top_x), 0.0, 1.0),
                                        std::clamp(static_cast<qreal>(_trackingImageStatus.rec_top_y), 0.0, 1.0)),
                                QPointF(std::clamp(static_cast<qreal>(_trackingImageStatus.rec_bottom_x), 0.0, 1.0),
                                        std::clamp(static_cast<qreal>(_trackingImageStatus.rec_bottom_y), 0.0, 1.0))).normalized();
        qCDebug(VehicleCameraControlLog) << "Tracking Rect [" << rect << "]";
        _trackingImagePoint = {};
        _trackingImageRadius = 0.0;
        if (_trackingImageRect != rect) {
            _trackingImageRect = rect;
            emit trackingImageRectChanged();
        }
    }
 
    if (_trackingImageIsActive != active) {
        _trackingImageIsActive = active;
        emit trackingImageIsActiveChanged();
    }
    if (_trackingImageIsPoint != isPoint) {
        _trackingImageIsPoint = isPoint;
        emit trackingImageIsPointChanged();
    }
}
 
void VehicleCameraControl::setCurrentStream(int stream)
{
    if (stream != _currentStream && stream >= 0 && stream < _streamLabels.count()) {
        QGCVideoStreamInfo* pInfo = currentStreamInstance();
        if(pInfo) {
            qCDebug(VehicleCameraControlLog) << "Stopping stream:" << pInfo->uri();
            //-- Stop current stream
            _vehicle->sendMavCommand(
                _compID,                                // Target component
                MAV_CMD_VIDEO_STOP_STREAMING,           // Command id
                false,                                  // ShowError
                pInfo->streamID());                     // Stream ID
        }
        _currentStream = stream;
        pInfo = currentStreamInstance();
        if(pInfo) {
            //-- Start new stream
            qCDebug(VehicleCameraControlLog) << "Starting stream:" << pInfo->uri();
            _vehicle->sendMavCommand(
                _compID,                                // Target component
                MAV_CMD_VIDEO_START_STREAMING,          // Command id
                false,                                  // ShowError
                pInfo->streamID());                     // Stream ID
            //-- Update stream status
            _requestStreamStatus(static_cast<uint8_t>(pInfo->streamID()));
        }
        emit currentStreamChanged();
        emit _vehicle->cameraManager()->streamChanged();
    }
}
 
void VehicleCameraControl::stopStream()
{
    QGCVideoStreamInfo* pInfo = currentStreamInstance();
    if(pInfo) {
        //-- Stop current stream
        _vehicle->sendMavCommand(
            _compID,                                // Target component
            MAV_CMD_VIDEO_STOP_STREAMING,           // Command id
            false,                                  // ShowError
            pInfo->streamID());                     // Stream ID
    }
}
 
void VehicleCameraControl::resumeStream()
{
    QGCVideoStreamInfo* pInfo = currentStreamInstance();
    if(pInfo) {
        //-- Start new stream
        _vehicle->sendMavCommand(
            _compID,                                // Target component
            MAV_CMD_VIDEO_START_STREAMING,          // Command id
            false,                                  // ShowError
            pInfo->streamID());                     // Stream ID
    }
}
 
bool VehicleCameraControl::autoStream() const
{
    if(hasVideoStream()) {
        return _streams.count() > 0;
    }
    return false;
}
 
QGCVideoStreamInfo*
VehicleCameraControl::currentStreamInstance()
{
    if(_currentStream < _streamLabels.count() && _streamLabels.count()) {
        QGCVideoStreamInfo* pStream = _findStream(_streamLabels[_currentStream]);
        return pStream;
    }
    return nullptr;
}
 
QGCVideoStreamInfo*
VehicleCameraControl::thermalStreamInstance()
{
    //-- For now, it will return the first thermal listed (if any)
    for(int i = 0; i < _streams.count(); i++) {
        if(_streams[i]) {
            QGCVideoStreamInfo* pStream = qobject_cast<QGCVideoStreamInfo*>(_streams[i]);
            if(pStream) {
                if(pStream->isThermal()) {
                    return pStream;
                }
            }
        }
    }
    return nullptr;
}
 
void VehicleCameraControl::_requestStreamInfo(uint8_t streamID)
{
    qCDebug(VehicleCameraControlLog) << "_requestStreamInfo() - stream:" << streamID << "retries:" << _videoStreamInfoRetries;
    // By default, try to use new REQUEST_MESSAGE command instead of
    // deprecated MAV_CMD_REQUEST_VIDEO_STREAM_INFORMATION.
    if (_videoStreamInfoRetries % 2 == 0) {
        qCDebug(VehicleCameraControlLog) << "  Sending REQUEST_MESSAGE:MAVLINK_MSG_ID_VIDEO_STREAM_INFORMATION";
        _vehicle->sendMavCommand(
            _compID,                                         // target component
            MAV_CMD_REQUEST_MESSAGE,                        // command id
            false,                                          // showError
            MAVLINK_MSG_ID_VIDEO_STREAM_INFORMATION,        // msgid
            streamID);                                      // stream ID
    } else {
        qCDebug(VehicleCameraControlLog) << "  Sending MAV_CMD_REQUEST_VIDEO_STREAM_INFORMATION (legacy)";
        _vehicle->sendMavCommand(
            _compID,                                            // Target component
            MAV_CMD_REQUEST_VIDEO_STREAM_INFORMATION,           // Command id
            false,                                              // ShowError
            streamID);                                          // Stream ID
    }
    _streamInfoTimer.start(1000);                           // Wait up to a second for it
}
 
void VehicleCameraControl::_requestStreamStatus(uint8_t streamID)
{
    qCDebug(VehicleCameraControlLog) << "_requestStreamStatus() - stream:" << streamID << "retries:" << _videoStreamStatusRetries;
    // By default, try to use new REQUEST_MESSAGE command instead of
    // deprecated MAV_CMD_REQUEST_VIDEO_STREAM_STATUS.
    if (_videoStreamStatusRetries % 2 == 0) {
        qCDebug(VehicleCameraControlLog) << "  Sending REQUEST_MESSAGE:MAVLINK_MSG_ID_VIDEO_STREAM_STATUS";
        _vehicle->sendMavCommand(
            _compID,                                         // target component
            MAV_CMD_REQUEST_MESSAGE,                        // command id
            false,                                          // showError
            MAVLINK_MSG_ID_VIDEO_STREAM_STATUS,             // msgid
            streamID);                                      // stream id
    } else {
        qCDebug(VehicleCameraControlLog) << "  Sending MAV_CMD_REQUEST_VIDEO_STREAM_STATUS (legacy)";
        _vehicle->sendMavCommand(
            _compID,                                            // Target component
            MAV_CMD_REQUEST_VIDEO_STREAM_STATUS,                // Command id
            false,                                              // ShowError
            streamID);                                          // Stream ID
    }
    _streamStatusTimer.start(1000);                         // Wait up to a second for it
}
 
QGCVideoStreamInfo*
VehicleCameraControl::_findStream(uint8_t id, bool report)
{
    for(int i = 0; i < _streams.count(); i++) {
        if(_streams[i]) {
            QGCVideoStreamInfo* pStream = qobject_cast<QGCVideoStreamInfo*>(_streams[i]);
            if(pStream) {
                if(pStream->streamID() == id) {
                    return pStream;
                }
            } else {
                qCritical() << "Null QGCVideoStreamInfo instance";
            }
        }
    }
    if(report) {
        qWarning() << "Stream id not found:" << id;
    }
    return nullptr;
}
 
QGCVideoStreamInfo*
VehicleCameraControl::_findStream(const QString name)
{
    for(int i = 0; i < _streams.count(); i++) {
        if(_streams[i]) {
            QGCVideoStreamInfo* pStream = qobject_cast<QGCVideoStreamInfo*>(_streams[i]);
            if(pStream) {
                if(pStream->name() == name) {
                    return pStream;
                }
            }
        }
    }
    return nullptr;
}
 
void VehicleCameraControl::_streamInfoTimeout()
{
    _videoStreamInfoRetries++;
    int count = _expectedCount * 6;
    if(_videoStreamInfoRetries > count) {
        qCWarning(VehicleCameraControlLog) << "Giving up requesting video stream info";
        _streamInfoTimer.stop();
        //-- If we have at least one stream, work with what we have.
        if(_streams.count()) {
            emit autoStreamChanged();
            emit _vehicle->cameraManager()->streamChanged();
        }
        return;
    }
    for(uint8_t i = 0; i < _expectedCount; i++) {
        //-- Stream ID starts at 1
        if(!_findStream(i+1, false)) {
            _requestStreamInfo(i+1);
            return;
        }
    }
}
 
void VehicleCameraControl::_streamStatusTimeout()
{
    _videoStreamStatusRetries++;
    if(_videoStreamStatusRetries > 5) {
        qCWarning(VehicleCameraControlLog) << "Giving up requesting video stream status";
        _streamStatusTimer.stop();
        return;
    }
    QGCVideoStreamInfo* pStream = currentStreamInstance();
    if(pStream) {
        _requestStreamStatus(static_cast<uint8_t>(pStream->streamID()));
    }
}
 
void VehicleCameraControl::_cameraSettingsTimeout()
{
    _cameraSettingsRetries++;
    qCDebug(VehicleCameraControlLog) << "_cameraSettingsTimeout() - retries now:" << _cameraSettingsRetries;
    if(_cameraSettingsRetries > 5) {
        qCWarning(VehicleCameraControlLog) << "Giving up requesting camera settings after" << _cameraSettingsRetries << "retries";
        _cameraSettingsTimer.stop();
        return;
    }
    qCDebug(VehicleCameraControlLog) << "_cameraSettingsTimeout() - calling _requestCameraSettings()";
    _requestCameraSettings();
}
 
void VehicleCameraControl::_storageInfoTimeout()
{
    _storageInfoRetries++;
    qCDebug(VehicleCameraControlLog) << "_storageInfoTimeout() - retries now:" << _storageInfoRetries;
    if(_storageInfoRetries > 5) {
        qCWarning(VehicleCameraControlLog) << "Giving up requesting storage info after" << _storageInfoRetries << "retries";
        _storageInfoTimer.stop();
        return;
    }
    qCDebug(VehicleCameraControlLog) << "_storageInfoTimeout() - calling _requestStorageInfo()";
    _requestStorageInfo();
}
 
QStringList
VehicleCameraControl::_loadExclusions(QDomNode option)
{
    QStringList exclusionList;
    QDomElement optionElem = option.toElement();
    QDomNodeList excRoot = optionElem.elementsByTagName(kExclusions);
    if(excRoot.size()) {
        //-- Iterate exclusions
        QDomNode node = excRoot.item(0);
        QDomElement elem = node.toElement();
        QDomNodeList exclusions = elem.elementsByTagName(kExclusion);
        for(int i = 0; i < exclusions.size(); i++) {
            QString exclude = exclusions.item(i).toElement().text();
            if(!exclude.isEmpty()) {
                exclusionList << exclude;
            }
        }
    }
    return exclusionList;
}
 
QStringList
VehicleCameraControl::_loadUpdates(QDomNode option)
{
    QStringList updateList;
    QDomElement optionElem = option.toElement();
    QDomNodeList updateRoot = optionElem.elementsByTagName(kUpdates);
    if(updateRoot.size()) {
        //-- Iterate updates
        QDomNode node = updateRoot.item(0);
        QDomElement elem = node.toElement();
        QDomNodeList updates = elem.elementsByTagName(kUpdate);
        for(int i = 0; i < updates.size(); i++) {
            QString update = updates.item(i).toElement().text();
            if(!update.isEmpty()) {
                updateList << update;
            }
        }
    }
    return updateList;
}
 
bool VehicleCameraControl::_loadRanges(QDomNode option, const QString factName, QString paramValue)
{
    QDomElement optionElem = option.toElement();
    QDomNodeList rangeRoot = optionElem.elementsByTagName(kParameterranges);
    if(rangeRoot.size()) {
        QDomNode node = rangeRoot.item(0);
        QDomElement elem = node.toElement();
        QDomNodeList parameterRanges = elem.elementsByTagName(kParameterrange);
        //-- Iterate parameter ranges
        for(int i = 0; i < parameterRanges.size(); i++) {
            QString param;
            QString condition;
            QDomNode paramRange = parameterRanges.item(i);
            if(!read_attribute(paramRange, kParameter, param)) {
                qCritical() << QString("Malformed option range for parameter %1").arg(factName);
                return false;
            }
            read_attribute(paramRange, kCondition, condition);
            QDomElement pelem = paramRange.toElement();
            QDomNodeList rangeOptions = pelem.elementsByTagName(kRoption);
            QStringList  optNames;
            QStringList  optValues;
            //-- Iterate options
            for(int rangeOptionIndex = 0; rangeOptionIndex < rangeOptions.size(); rangeOptionIndex++) {
                QString optName;
                QString optValue;
                QDomNode roption = rangeOptions.item(rangeOptionIndex);
                if(!read_attribute(roption, kName, optName)) {
                    qCritical() << QString("Malformed roption for parameter %1").arg(factName);
                    return false;
                }
                if(!read_attribute(roption, kValue, optValue)) {
                    qCritical() << QString("Malformed rvalue for parameter %1").arg(factName);
                    return false;
                }
                optNames  << optName;
                optValues << optValue;
            }
            if(optNames.size()) {
                QGCCameraOptionRange* pRange = new QGCCameraOptionRange(this, factName, paramValue, param, condition, optNames, optValues);
                _optionRanges.append(pRange);
                qCDebug(VehicleCameraControlVerboseLog) << "New range limit:" << factName << paramValue << param << condition << optNames << optValues;
            }
        }
    }
    return true;
}
 
void VehicleCameraControl::_processRanges()
{
    //-- After all parameter are loaded, process parameter ranges
    for(QGCCameraOptionRange* pRange: _optionRanges) {
        Fact* pRFact = getFact(pRange->targetParam);
        if(pRFact) {
            for(int i = 0; i < pRange->optNames.size(); i++) {
                QVariant optVariant;
                QString  errorString;
                if (!pRFact->metaData()->convertAndValidateRaw(pRange->optValues[i], false, optVariant, errorString)) {
                    qWarning() << "Invalid roption value, name:" << pRange->targetParam
                               << " type:"  << pRFact->metaData()->type()
                               << " value:" << pRange->optValues[i]
                               << " error:" << errorString;
                } else {
                    pRange->optVariants << optVariant;
                }
            }
        }
    }
}
 
bool VehicleCameraControl::_loadNameValue(QDomNode option, const QString factName, FactMetaData* metaData, QString& optName, QString& optValue, QVariant& optVariant)
{
    if(!read_attribute(option, kName, optName)) {
        qCritical() << QString("Malformed option for parameter %1").arg(factName);
        return false;
    }
    if(!read_attribute(option, kValue, optValue)) {
        qCritical() << QString("Malformed value for parameter %1").arg(factName);
        return false;
    }
    QString  errorString;
    if (!metaData->convertAndValidateRaw(optValue, false, optVariant, errorString)) {
        qWarning() << "Invalid option value, name:" << factName
                   << " type:"  << metaData->type()
                   << " value:" << optValue
                   << " error:" << errorString;
    }
    return true;
}
 
void VehicleCameraControl::_handleDefinitionFile(const QString &url)
{
    //-- First check and see if we have it cached
    QFile xmlFile(_cacheFile);
 
    QString ftpPrefix(QStringLiteral("%1://").arg(FTPManager::mavlinkFTPScheme));
    if (!xmlFile.exists() && url.startsWith(ftpPrefix, Qt::CaseInsensitive)) {
        qCDebug(VehicleCameraControlLog) << "No camera definition file cached, attempt ftp download";
        int ver = static_cast<int>(_mavlinkCameraInfo.cam_definition_version);
        QString ext = "";
        if (url.endsWith(".lzma", Qt::CaseInsensitive)) { ext = ".lzma"; }
        if (url.endsWith(".xz", Qt::CaseInsensitive)) { ext = ".xz"; }
        QString fileName = QString::asprintf("%s_%s_%03d.xml%s",
            _vendor.toStdString().c_str(),
            _modelName.toStdString().c_str(),
            ver,
            ext.toStdString().c_str());
        connect(_vehicle->ftpManager(), &FTPManager::downloadComplete, this, &VehicleCameraControl::_ftpDownloadComplete);
        _vehicle->ftpManager()->download(_compID, url,
            SettingsManager::instance()->appSettings()->parameterSavePath().toStdString().c_str(),
            fileName);
        return;
    }
 
    if (!xmlFile.exists()) {
        qCDebug(VehicleCameraControlLog) << "No camera definition file cached, attempt http download";
        _httpRequest(url);
        return;
    }
    if (!xmlFile.open(QIODevice::ReadOnly)) {
        qWarning() << "Could not read cached camera definition file:" << _cacheFile;
        _httpRequest(url);
        return;
    }
    QByteArray bytes = xmlFile.readAll();
    QDomDocument doc;
    const QDomDocument::ParseResult result = doc.setContent(bytes, QDomDocument::ParseOption::Default);
    if (!result) {
        qWarning() << "Could not parse cached camera definition file:" << _cacheFile;
        _httpRequest(url);
        return;
    }
    //-- We have it
    qCDebug(VehicleCameraControlLog) << "Using cached camera definition file:" << _cacheFile;
    _cached = true;
    emit dataReady(bytes);
}
 
void VehicleCameraControl::_httpRequest(const QString &url)
{
    qCDebug(VehicleCameraControlLog) << "Request camera definition:" << url;
    if(!_netManager) {
        _netManager = new QNetworkAccessManager(this);
    }
    QGCNetworkHelper::configureProxy(_netManager);
    QNetworkRequest request(QUrl::fromUserInput(url));
    request.setAttribute(QNetworkRequest::RedirectPolicyAttribute, true);
    QSslConfiguration conf = request.sslConfiguration();
    conf.setPeerVerifyMode(QSslSocket::VerifyNone);
    request.setSslConfiguration(conf);
    QNetworkReply* reply = _netManager->get(request);
    connect(reply, &QNetworkReply::finished,  this, &VehicleCameraControl::_downloadFinished);
}
 
void VehicleCameraControl::_downloadFinished()
{
    QNetworkReply* reply = qobject_cast<QNetworkReply*>(sender());
    if(!reply) {
        return;
    }
    int err = reply->error();
    int http_code = reply->attribute(QNetworkRequest::HttpStatusCodeAttribute).toInt();
    QByteArray data = reply->readAll();
    if(err == QNetworkReply::NoError && http_code == 200) {
        data.append("\n");
    } else {
        data.clear();
        qWarning() << QString("Camera Definition (%1) download error: %2 status: %3").arg(
            reply->url().toDisplayString(),
            reply->errorString(),
            reply->attribute(QNetworkRequest::HttpStatusCodeAttribute).toString()
        );
    }
    emit dataReady(data);
    //reply->deleteLater();
}
 
void VehicleCameraControl::_ftpDownloadComplete(const QString& fileName, const QString& errorMsg)
{
    qCDebug(VehicleCameraControlLog) << "FTP Download completed: " << fileName << ", " << errorMsg;
 
    disconnect(_vehicle->ftpManager(), &FTPManager::downloadComplete, this, &VehicleCameraControl::_ftpDownloadComplete);
 
    QString outputFileName = QGCCompression::decompressIfNeeded(fileName);
    if (outputFileName.isEmpty()) {
        qCWarning(VehicleCameraControlLog) << "Inflate of compressed xml failed" << fileName;
    }
 
    QFile xmlFile(outputFileName);
 
    if (!xmlFile.exists()) {
        qCDebug(VehicleCameraControlLog) << "No camera definition file present after ftp download completed";
        return;
    }
    if (!xmlFile.open(QIODevice::ReadOnly)) {
        qWarning() << "Could not read downloaded camera definition file: " << fileName;
        return;
    }
 
    _cached = true;
    QByteArray bytes = xmlFile.readAll();
    emit dataReady(bytes);
}
 
void VehicleCameraControl::_dataReady(QByteArray data)
{
    if(data.size()) {
        qCDebug(VehicleCameraControlLog) << "Parsing camera definition";
        _loadCameraDefinitionFile(data);
    } else {
        qCDebug(VehicleCameraControlLog) << "No camera definition received, trying to search on our own...";
        QFile definitionFile;
        if(QGCCorePlugin::instance()->getOfflineCameraDefinitionFile(_modelName, definitionFile)) {
            qCDebug(VehicleCameraControlLog) << "Found offline definition file for: " << _modelName << ", loading: " << definitionFile.fileName();
            if (definitionFile.open(QIODevice::ReadOnly)) {
                QByteArray newData = definitionFile.readAll();
                _loadCameraDefinitionFile(newData);
            } else {
                qCDebug(VehicleCameraControlLog) << "error opening offline definition file for: " << _modelName;
            }
        } else {
            qCDebug(VehicleCameraControlLog) << "No offline camera definition file found";
        }
    }
    _initWhenReady();
}
 
void VehicleCameraControl::_paramDone()
{
    for(const QString& param: _paramIO.keys()) {
        if(!_paramIO[param]->paramDone()) {
            return;
        }
    }
    //-- All parameters loaded (or timed out)
    _paramComplete = true;
    emit parametersReady();
}
 
void VehicleCameraControl::_checkForVideoStreams()
{
    if(_mavlinkCameraInfo.flags & CAMERA_CAP_FLAGS_HAS_VIDEO_STREAM) {
        connect(&_streamInfoTimer, &QTimer::timeout, this, &VehicleCameraControl::_streamInfoTimeout);
        _streamInfoTimer.setSingleShot(false);
        connect(&_streamStatusTimer, &QTimer::timeout, this, &VehicleCameraControl::_streamStatusTimeout);
        _streamStatusTimer.setSingleShot(true);
        //-- Request all streams
        _requestStreamInfo(0);
        _streamInfoTimer.start(2000);
    }
}
 
bool VehicleCameraControl::incomingParameter(Fact* pFact, QVariant& newValue)
{
    Q_UNUSED(pFact);
    Q_UNUSED(newValue);
    return true;
}
 
bool VehicleCameraControl::validateParameter(Fact* pFact, QVariant& newValue)
{
    Q_UNUSED(pFact);
    Q_UNUSED(newValue);
    return true;
}
 
QStringList
VehicleCameraControl::activeSettings() const
{
    qCDebug(VehicleCameraControlLog) << "Active:" << _activeSettings;
    return _activeSettings;
}
 
Fact*
VehicleCameraControl::exposureMode()
{
    return (_paramComplete && _activeSettings.contains(kCAM_EXPMODE)) ? getFact(kCAM_EXPMODE) : nullptr;
}
 
Fact*
VehicleCameraControl::ev()
{
    return (_paramComplete && _activeSettings.contains(kCAM_EV)) ? getFact(kCAM_EV) : nullptr;
}
 
Fact*
VehicleCameraControl::iso()
{
    return (_paramComplete && _activeSettings.contains(kCAM_ISO)) ? getFact(kCAM_ISO) : nullptr;
}
 
Fact*
VehicleCameraControl::shutterSpeed()
{
    return (_paramComplete && _activeSettings.contains(kCAM_SHUTTERSPD)) ? getFact(kCAM_SHUTTERSPD) : nullptr;
}
 
Fact*
VehicleCameraControl::aperture()
{
    return (_paramComplete && _activeSettings.contains(kCAM_APERTURE)) ? getFact(kCAM_APERTURE) : nullptr;
}
 
Fact*
VehicleCameraControl::wb()
{
    return (_paramComplete && _activeSettings.contains(kCAM_WBMODE)) ? getFact(kCAM_WBMODE) : nullptr;
}
 
Fact*
VehicleCameraControl::mode()
{
    return _paramComplete && factExists(kCAM_MODE) ? getFact(kCAM_MODE) : nullptr;
}
 
void VehicleCameraControl::setTrackingEnabled(bool set)
{
    if (_trackingEnabled == set) {
        return;
    }
    _trackingEnabled = set;
    if (!set) {
        stopTracking();
    }
    emit trackingEnabledChanged();
}
 
void VehicleCameraControl::startTrackingRect(QRectF rec)
{
    if (!_hasTrackingRectCapability) {
        qCCritical(VehicleCameraControlLog) << "startTrackingRect called but camera does not have rectangle tracking capability";
        return;
    }
 
    qCDebug(VehicleCameraControlLog) << "Start Tracking (Rectangle: ["
                              << static_cast<float>(rec.x()) << ", "
                              << static_cast<float>(rec.y()) << "] - ["
                              << static_cast<float>(rec.x() + rec.width()) << ", "
                              << static_cast<float>(rec.y() + rec.height()) << "]";
 
    _vehicle->sendMavCommand(_compID,
                             MAV_CMD_CAMERA_TRACK_RECTANGLE,
                             true,
                             static_cast<float>(rec.x()),
                             static_cast<float>(rec.y()),
                             static_cast<float>(rec.x() + rec.width()),
                             static_cast<float>(rec.y() + rec.height()));
 
    _requestTrackingStatus();
}
 
void VehicleCameraControl::startTrackingPoint(QPointF point, double radius)
{
    if (!_hasTrackingPointCapability) {
        qCCritical(VehicleCameraControlLog) << "startTrackingPoint called but camera does not have point tracking capability";
        return;
    }
 
    qCDebug(VehicleCameraControlLog) << "Start Tracking (Point: ["
                              << static_cast<float>(point.x()) << ", "
                              << static_cast<float>(point.y()) << "], Radius:  "
                              << static_cast<float>(radius);
 
    _vehicle->sendMavCommand(_compID,
                             MAV_CMD_CAMERA_TRACK_POINT,
                             true,
                             static_cast<float>(point.x()),
                             static_cast<float>(point.y()),
                             static_cast<float>(radius));
 
    _requestTrackingStatus();
}
 
void VehicleCameraControl::stopTracking()
{
    qCDebug(VehicleCameraControlLog) << "Stop Tracking";
 
    //-- Stop Tracking
    _vehicle->sendMavCommand(_compID,
                             MAV_CMD_CAMERA_STOP_TRACKING,
                             true);
 
    //-- Stop Sending Tracking Status
    _vehicle->sendMavCommand(_compID,
                             MAV_CMD_SET_MESSAGE_INTERVAL,
                             true,
                             MAVLINK_MSG_ID_CAMERA_TRACKING_IMAGE_STATUS,
                             -1);
 
    // reset tracking state
    _trackingImageRect = {};
    _trackingImagePoint = {};
    _trackingImageRadius = 0.0;
    if (_trackingImageIsActive) {
        _trackingImageIsActive = false;
        emit trackingImageIsActiveChanged();
    }
    if (_trackingImageIsPoint) {
        _trackingImageIsPoint = false;
        emit trackingImageIsPointChanged();
    }
}
 
void VehicleCameraControl::_requestTrackingStatus()
{
    _vehicle->sendMavCommand(_compID,
                             MAV_CMD_SET_MESSAGE_INTERVAL,
                             true,
                             MAVLINK_MSG_ID_CAMERA_TRACKING_IMAGE_STATUS,
                             500000); // Interval (us)
}