Skip to content
Snippets Groups Projects
Fact.cc 11.7 KiB
Newer Older
  • Learn to ignore specific revisions
  • Don Gagne's avatar
    Don Gagne committed
    /*=====================================================================
     
     QGroundControl Open Source Ground Control Station
     
     (c) 2009 - 2014 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
     
     This file is part of the QGROUNDCONTROL project
     
     QGROUNDCONTROL is free software: you can redistribute it and/or modify
     it under the terms of the GNU General Public License as published by
     the Free Software Foundation, either version 3 of the License, or
     (at your option) any later version.
     
     QGROUNDCONTROL is distributed in the hope that it will be useful,
     but WITHOUT ANY WARRANTY; without even the implied warranty of
     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
     GNU General Public License for more details.
     
     You should have received a copy of the GNU General Public License
     along with QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.
     
     ======================================================================*/
    
    /// @file
    ///     @author Don Gagne <don@thegagnes.com>
    
    #include "Fact.h"
    
    Don Gagne's avatar
    Don Gagne committed
    #include "QGCMAVLink.h"
    
    Don Gagne's avatar
    Don Gagne committed
    
    #include <QtQml>
    
    
    Don Gagne's avatar
    Don Gagne committed
    Fact::Fact(QObject* parent)
        : QObject(parent)
        , _componentId(-1)
    
        , _rawValue(0)
    
    Don Gagne's avatar
    Don Gagne committed
        , _type(FactMetaData::valueTypeInt32)
        , _metaData(NULL)
    
    Don Gagne's avatar
    Don Gagne committed
    {    
        FactMetaData* metaData = new FactMetaData(_type, this);
        setMetaData(metaData);
    }
    
    
    Don Gagne's avatar
    Don Gagne committed
    Fact::Fact(int componentId, QString name, FactMetaData::ValueType_t type, QObject* parent)
        : QObject(parent)
        , _name(name)
        , _componentId(componentId)
    
        , _rawValue(0)
    
    Don Gagne's avatar
    Don Gagne committed
        , _type(type)
        , _metaData(NULL)
    
    Don Gagne's avatar
    Don Gagne committed
    {
    
    Don Gagne's avatar
    Don Gagne committed
        FactMetaData* metaData = new FactMetaData(_type, this);
        setMetaData(metaData);
    }
    
    Don Gagne's avatar
    Don Gagne committed
    
    
    Don Gagne's avatar
    Don Gagne committed
    Fact::Fact(const Fact& other, QObject* parent)
        : QObject(parent)
    {
        *this = other;
    }
    
    const Fact& Fact::operator=(const Fact& other)
    {
        _name           = other._name;
        _componentId    = other._componentId;
    
        _rawValue          = other._rawValue;
    
    Don Gagne's avatar
    Don Gagne committed
        _type           = other._type;
        
        if (_metaData && other._metaData) {
            *_metaData = *other._metaData;
        } else {
            _metaData = NULL;
        }
        
        return *this;
    
    Don Gagne's avatar
    Don Gagne committed
    }
    
    
    Don Gagne's avatar
    Don Gagne committed
    void Fact::forceSetRawValue(const QVariant& value)
    
    {
        if (_metaData) {
            QVariant    typedValue;
            QString     errorString;
            
            if (_metaData->convertAndValidate(value, true /* convertOnly */, typedValue, errorString)) {
    
    Don Gagne's avatar
    Don Gagne committed
                _rawValue.setValue(typedValue);
                emit valueChanged(cookedValue());
                emit _containerRawValueChanged(rawValue());
    
            }
        } else {
            qWarning() << "Meta data pointer missing";
        }
    }
    
    
    void Fact::setRawValue(const QVariant& value)
    
    Don Gagne's avatar
    Don Gagne committed
    {
    
    Don Gagne's avatar
    Don Gagne committed
        if (_metaData) {
            QVariant    typedValue;
            QString     errorString;
            
            if (_metaData->convertAndValidate(value, true /* convertOnly */, typedValue, errorString)) {
    
                if (typedValue != _rawValue) {
                    _rawValue.setValue(typedValue);
    
    Don Gagne's avatar
    Don Gagne committed
                    emit valueChanged(cookedValue());
                    emit _containerRawValueChanged(rawValue());
    
    Don Gagne's avatar
    Don Gagne committed
                }
            }
        } else {
            qWarning() << "Meta data pointer missing";
    
    Don Gagne's avatar
    Don Gagne committed
    }
    
    
    Don Gagne's avatar
    Don Gagne committed
    void Fact::setCookedValue(const QVariant& value)
    
    {
        if (_metaData) {
            setRawValue(_metaData->cookedTranslator()(value));
        } else {
            qWarning() << "Meta data pointer missing";
        }
    }
    
    void Fact::setEnumStringValue(const QString& value)
    {
        if (_metaData) {
            int index = _metaData->enumStrings().indexOf(value);
            if (index != -1) {
    
    Don Gagne's avatar
    Don Gagne committed
                setCookedValue(_metaData->enumValues()[index]);
    
            }
        } else {
            qWarning() << "Meta data pointer missing";
        }
    }
    
    void Fact::setEnumIndex(int index)
    {
        if (_metaData) {
    
    Don Gagne's avatar
    Don Gagne committed
            setCookedValue(_metaData->enumValues()[index]);
    
        } else {
            qWarning() << "Meta data pointer missing";
        }
    }
    
    
    Don Gagne's avatar
    Don Gagne committed
    void Fact::_containerSetRawValue(const QVariant& value)
    
    Don Gagne's avatar
    Don Gagne committed
    {
    
        _rawValue = value;
    
    Don Gagne's avatar
    Don Gagne committed
        emit valueChanged(cookedValue());
    
        emit vehicleUpdated(_rawValue);
    
    Don Gagne's avatar
    Don Gagne committed
    }
    
    
    QString Fact::name(void) const
    {
        return _name;
    }
    
    
    int Fact::componentId(void) const
    {
        return _componentId;
    }
    
    
    Don Gagne's avatar
    Don Gagne committed
    QVariant Fact::cookedValue(void) const
    
        if (_metaData) {
            return _metaData->rawTranslator()(_rawValue);
        } else {
            qWarning() << "Meta data pointer missing";
            return _rawValue;
        }
    }
    
    
    QString Fact::enumStringValue(void)
    
    {
        if (_metaData) {
            int enumIndex = this->enumIndex();
    
    Don Gagne's avatar
    Don Gagne committed
            if (enumIndex >= 0 && enumIndex < _metaData->enumStrings().count()) {
    
                return _metaData->enumStrings()[enumIndex];
            }
        } else {
            qWarning() << "Meta data pointer missing";
        }
    
        return QString();
    }
    
    
    int Fact::enumIndex(void)
    
    {
        if (_metaData) {
            int index = 0;
    
            foreach (QVariant enumValue, _metaData->enumValues()) {
    
    Don Gagne's avatar
    Don Gagne committed
                if (enumValue == rawValue()) {
    
                    return index;
                }
                index ++;
            }
    
    
            // Current value is not in list, add it manually
            _metaData->addEnumInfo(QString("Unknown: %1").arg(rawValue().toString()), rawValue());
            emit enumStringsChanged();
            emit enumValuesChanged();
            return index;
    
        } else {
            qWarning() << "Meta data pointer missing";
        }
    
        return -1;
    }
    
    QStringList Fact::enumStrings(void) const
    {
        if (_metaData) {
            return _metaData->enumStrings();
        } else {
            qWarning() << "Meta data pointer missing";
            return QStringList();
        }
    }
    
    QVariantList Fact::enumValues(void) const
    {
        if (_metaData) {
            return _metaData->enumValues();
        } else {
            qWarning() << "Meta data pointer missing";
            return QVariantList();
        }
    
    QString Fact::_variantToString(const QVariant& variant) const
    
        QString valueString;
    
        switch (type()) {
            case FactMetaData::valueTypeFloat:
    
                valueString = QString("%1").arg(variant.toFloat(), 0, 'f', decimalPlaces());
    
                break;
            case FactMetaData::valueTypeDouble:
    
                valueString = QString("%1").arg(variant.toDouble(), 0, 'f', decimalPlaces());
    
                break;
            default:
    
                valueString = variant.toString();
    
                break;
        }
    
        return valueString;
    
    QString Fact::valueString(void) const
    {
    
    Don Gagne's avatar
    Don Gagne committed
        return _variantToString(cookedValue());
    
    QVariant Fact::defaultValue(void) const
    
    Don Gagne's avatar
    Don Gagne committed
        if (_metaData) {
            if (!_metaData->defaultValueAvailable()) {
                qDebug() << "Access to unavailable default value";
            }
            return _metaData->defaultValue();
        } else {
            qWarning() << "Meta data pointer missing";
            return QVariant(0);
    
    QString Fact::defaultValueString(void) const
    {
        return _variantToString(defaultValue());
    }
    
    
    FactMetaData::ValueType_t Fact::type(void) const
    
    QString Fact::shortDescription(void) const
    
    Don Gagne's avatar
    Don Gagne committed
        if (_metaData) {
            return _metaData->shortDescription();
        } else {
            qWarning() << "Meta data pointer missing";
            return QString();
        }
    
    QString Fact::longDescription(void) const
    
    Don Gagne's avatar
    Don Gagne committed
        if (_metaData) {
            return _metaData->longDescription();
        } else {
            qWarning() << "Meta data pointer missing";
            return QString();
        }
    
    QString Fact::units(void) const
    
    Don Gagne's avatar
    Don Gagne committed
        if (_metaData) {
            return _metaData->units();
        } else {
            qWarning() << "Meta data pointer missing";
            return QString();
        }
    
    QVariant Fact::min(void) const
    
    Don Gagne's avatar
    Don Gagne committed
        if (_metaData) {
            return _metaData->min();
        } else {
            qWarning() << "Meta data pointer missing";
            return QVariant(0);
        }
    
    QString Fact::minString(void) const
    {
        return _variantToString(min());
    }
    
    
    QVariant Fact::max(void) const
    
    Don Gagne's avatar
    Don Gagne committed
        if (_metaData) {
            return _metaData->max();
        } else {
            qWarning() << "Meta data pointer missing";
            return QVariant(0);
        }
    }
    
    
    QString Fact::maxString(void) const
    {
        return _variantToString(max());
    }
    
    
    bool Fact::minIsDefaultForType(void) const
    
    Don Gagne's avatar
    Don Gagne committed
    {
        if (_metaData) {
            return _metaData->minIsDefaultForType();
        } else {
            qWarning() << "Meta data pointer missing";
            return false;
        }
    }
    
    
    bool Fact::maxIsDefaultForType(void) const
    
    Don Gagne's avatar
    Don Gagne committed
    {
        if (_metaData) {
            return _metaData->maxIsDefaultForType();
        } else {
            qWarning() << "Meta data pointer missing";
            return false;
        }
    
    int Fact::decimalPlaces(void) const
    {
        if (_metaData) {
            return _metaData->decimalPlaces();
        } else {
            qWarning() << "Meta data pointer missing";
            return FactMetaData::defaultDecimalPlaces;
        }
    }
    
    
    QString Fact::group(void) const
    
    Don Gagne's avatar
    Don Gagne committed
        if (_metaData) {
            return _metaData->group();
        } else {
            qWarning() << "Meta data pointer missing";
            return QString();
        }
    
    void Fact::setMetaData(FactMetaData* metaData)
    {
    
    Don Gagne's avatar
    Don Gagne committed
        static QStringList  apmFlightModeParamList;
        static QStringList  apmFlightModeEnumStrings;
        static QVariantList apmFlightModeEnumValues;
    
        static QStringList  apmChannelOptParamList;
        static QStringList  apmChannelOptEnumStrings;
        static QVariantList apmChannelOptEnumValues;
    
        // FIXME: Hack to stuff enums into APM parameters, wating on real APM metadata
    
        if (apmFlightModeEnumStrings.count() == 0) {
            apmFlightModeParamList << "FLTMODE1" << "FLTMODE2" << "FLTMODE3" << "FLTMODE4" << "FLTMODE5" << "FLTMODE6";
            apmFlightModeEnumStrings << "Stabilize" << "Acro" << "AltHold" << "Auto" << "Guided" << "Loiter" << "RTL" << "Circle"
                                     << "Land" << "Drift" << "Sport" << "Flip" << "AutoTune" << "PosHold" << "Brake";
            for (int i=0; i<apmFlightModeEnumStrings.count(); i++) {
                apmFlightModeEnumValues << QVariant(i);
            }
    
            apmChannelOptParamList << "CH7_OPT" << "CH8_OPT" << "CH9_OPT" << "CH10_OPT" << "CH11_OPT" << "CH12_OPT";
            apmChannelOptEnumStrings << "Do Nothing" << "Flip" << "Simple Mode" << "RTL" << "Save Trim" << "Save WP" << "Camera Trigger" << "RangeFinder"
                                     << "Fence" << "ResetToArmedYaw" << "Super Simple Mode" << "Acro Trainer" << "Auto" << "AutoTune" << "Land" << "EPM"
                                     << "Parachute Enable" << "Parachute Release" << "Parachute 3pos" << "Auto Mission Reset" << "AttCon Feed Forward"
                                     << "AttCon Accel Limits" << "Retract Mount" << "Relay On/Off" << "Landing Gear" << "Lost Copter Sound"
                                     << "Motor Emergency Stop" << "Motor Interlock" << "Brake";
            for (int i=0; i<apmChannelOptEnumStrings.count(); i++) {
                apmChannelOptEnumValues << QVariant(i);
            }
        }
    
        if (apmFlightModeParamList.contains(name())) {
            metaData->setEnumInfo(apmFlightModeEnumStrings, apmFlightModeEnumValues);
        } else if (apmChannelOptParamList.contains(name())) {
            metaData->setEnumInfo(apmChannelOptEnumStrings, apmChannelOptEnumValues);
        }
    
    
        _metaData = metaData;
    
    Don Gagne's avatar
    Don Gagne committed
        emit valueChanged(cookedValue());
    
    bool Fact::valueEqualsDefault(void) const
    
    Don Gagne's avatar
    Don Gagne committed
        if (_metaData) {
            if (_metaData->defaultValueAvailable()) {
    
    Don Gagne's avatar
    Don Gagne committed
                return _metaData->defaultValue() == rawValue();
    
    Don Gagne's avatar
    Don Gagne committed
            } else {
                return false;
            }
    
        } else {
    
    Don Gagne's avatar
    Don Gagne committed
            qWarning() << "Meta data pointer missing";
    
    bool Fact::defaultValueAvailable(void) const
    
    Don Gagne's avatar
    Don Gagne committed
        if (_metaData) {
            return _metaData->defaultValueAvailable();
        } else {
            qWarning() << "Meta data pointer missing";
            return false;
        }
    }
    
    QString Fact::validate(const QString& value, bool convertOnly)
    {
        if (_metaData) {
            
            QVariant    typedValue;
            QString     errorString;
            
            _metaData->convertAndValidate(value, convertOnly, typedValue, errorString);
            
            return errorString;
        } else {
            qWarning() << "Meta data pointer missing";
            return QString("Internal error: Meta data pointer missing");
        }
    }