Parameter.cc 3.87 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28
/*=====================================================================

QGroundControl Open Source Ground Control Station

(c) 2009, 2010 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
 *   @brief Implementation of class OpalRT::Parameter
 *   @author Bryan Godbolt <godbolt@ualberta.ca>
 */
29 30 31
#include "Parameter.h"
using namespace OpalRT;

32 33 34 35 36 37 38 39 40 41 42
//Parameter::Parameter(char *simulinkPath, char *simulinkName, uint8_t componentID,
//                     QGCParamID paramID, unsigned short opalID)
//                         : simulinkPath(new QString(simulinkPath)),
//                         simulinkName(new QString(simulinkName)),
//                         componentID(componentID),
//                         paramID(new QGCParamID(paramID)),
//                         opalID(opalID)
//
//{
//}
Parameter::Parameter(QString simulinkPath, QString simulinkName, uint8_t componentID,
43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61
                     QGCParamID paramID, unsigned short opalID)
                         : simulinkPath(new QString(simulinkPath)),
                         simulinkName(new QString(simulinkName)),
                         componentID(componentID),
                         paramID(new QGCParamID(paramID)),
                         opalID(opalID)

{
}
Parameter::Parameter(const Parameter &other)
    : componentID(other.componentID),
    opalID(other.opalID)
{
    simulinkPath = new QString(*other.simulinkPath);
    simulinkName = new QString(*other.simulinkName);
    paramID = new QGCParamID(*other.paramID);
}

Parameter::~Parameter()
62
{
63 64 65
    delete simulinkPath;
    delete simulinkName;
    delete paramID;
66
}
67 68 69 70 71 72 73 74 75 76 77 78

bool Parameter::operator ==(const Parameter& other) const
{
    return
            (*simulinkPath) == *(other.simulinkPath)
            && *simulinkName == *(other.simulinkName)
            && componentID == other.componentID
            && *paramID == *(other.paramID)
            && opalID == other.opalID;

}

79
float Parameter::getValue()
80 81 82 83 84 85 86 87 88 89 90 91
{
    unsigned short allocatedParams = 1;
    unsigned short numParams;
    unsigned short numValues = 1;
    unsigned short returnedNumValues;
    double value;

    int returnVal = OpalGetParameters(allocatedParams, &numParams, &opalID,
                                      numValues, &returnedNumValues, &value);

    if (returnVal != EOK)
    {
92
        OpalRT::OpalErrorMsg::displayLastErrorMsg();
93 94 95 96 97
        return FLT_MAX;
    }

    return static_cast<float>(value);
}
98 99 100 101 102 103 104 105 106 107 108 109 110

void Parameter::setValue(float val)
{
    unsigned short allocatedParams = 1;
    unsigned short numParams;
    unsigned short numValues = 1;
    unsigned short returnedNumValues;
    double value = static_cast<double>(val);

    int returnVal = OpalSetParameters(allocatedParams, &numParams, &opalID,
                                      numValues, &returnedNumValues, &value);
    if (returnVal != EOK)
    {
111
        //qDebug() << __FILE__ << ":" << __LINE__ << ": Error numer: " << QString::number(returnVal);
112 113 114 115 116 117 118 119 120
        OpalErrorMsg::displayLastErrorMsg();
    }
}

Parameter::operator QString() const
{
    return *simulinkPath + *simulinkName + " " + QString::number(componentID)
            + " " + *paramID + " " + QString::number(opalID);
}