QGCParamWidget.cc 42.2 KB
Newer Older
1 2 3 4
/*=====================================================================

QGroundControl Open Source Ground Control Station

pixhawk's avatar
pixhawk committed
5
(c) 2009, 2010 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27

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 QGCParamWidget
 *   @author Lorenz Meier <mail@qgroundcontrol.org>
 */
Lorenz Meier's avatar
Lorenz Meier committed
28 29
#include <cmath>
#include <float.h>
30 31
#include <QGridLayout>
#include <QPushButton>
32 33
#include <QFileDialog>
#include <QFile>
34
#include <QList>
35
#include <QTime>
36
#include <QSettings>
37
#include <QMessageBox>
LM's avatar
LM committed
38
#include <QApplication>
pixhawk's avatar
pixhawk committed
39 40 41

#include "QGCParamWidget.h"
#include "UASInterface.h"
Lorenz Meier's avatar
Lorenz Meier committed
42
#include "MainWindow.h"
pixhawk's avatar
pixhawk committed
43
#include <QDebug>
44
#include "QGC.h"
pixhawk's avatar
pixhawk committed
45

46 47 48 49
/**
 * @param uas MAV to set the parameters on
 * @param parent Parent widget
 */
pixhawk's avatar
pixhawk committed
50
QGCParamWidget::QGCParamWidget(UASInterface* uas, QWidget *parent) :
51 52
    QGCUASParamManager(uas, parent),
    components(new QMap<int, QTreeWidgetItem*>())
pixhawk's avatar
pixhawk committed
53
{
54 55 56
    // Load settings
    loadSettings();

lm's avatar
lm committed
57 58 59
    // Load default values and tooltips
    loadParameterInfoCSV(uas->getAutopilotTypeName(), uas->getSystemTypeName());

pixhawk's avatar
pixhawk committed
60 61
    // Create tree widget
    tree = new QTreeWidget(this);
lm's avatar
lm committed
62
    statusLabel = new QLabel();
lm's avatar
lm committed
63
    statusLabel->setAutoFillBackground(true);
64
    tree->setColumnWidth(70, 30);
pixhawk's avatar
pixhawk committed
65 66

    // Set tree widget as widget onto this component
67
    QGridLayout* horizontalLayout;
pixhawk's avatar
pixhawk committed
68
    //form->setAutoFillBackground(false);
69
    horizontalLayout = new QGridLayout(this);
70 71
    horizontalLayout->setHorizontalSpacing(6);
    horizontalLayout->setVerticalSpacing(6);
pixhawk's avatar
pixhawk committed
72
    horizontalLayout->setMargin(0);
73 74
    horizontalLayout->setSizeConstraint(QLayout::SetMinimumSize);
    //horizontalLayout->setSizeConstraint( QLayout::SetFixedSize );
pixhawk's avatar
pixhawk committed
75

lm's avatar
lm committed
76
    // Parameter tree
77
    horizontalLayout->addWidget(tree, 0, 0, 1, 3);
lm's avatar
lm committed
78 79

    // Status line
lm's avatar
lm committed
80
    statusLabel->setText(tr("Click refresh to download parameters"));
lm's avatar
lm committed
81 82 83 84
    horizontalLayout->addWidget(statusLabel, 1, 0, 1, 3);


    // BUTTONS
Jessica's avatar
Jessica committed
85
    QPushButton* refreshButton = new QPushButton(tr("Get"));
86 87
    refreshButton->setToolTip(tr("Load parameters currently in non-permanent memory of aircraft."));
    refreshButton->setWhatsThis(tr("Load parameters currently in non-permanent memory of aircraft."));
88
    connect(refreshButton, SIGNAL(clicked()), this, SLOT(requestParameterList()));
lm's avatar
lm committed
89
    horizontalLayout->addWidget(refreshButton, 2, 0);
90

Jessica's avatar
Jessica committed
91
    QPushButton* setButton = new QPushButton(tr("Set"));
92 93
    setButton->setToolTip(tr("Set current parameters in non-permanent onboard memory"));
    setButton->setWhatsThis(tr("Set current parameters in non-permanent onboard memory"));
94
    connect(setButton, SIGNAL(clicked()), this, SLOT(setParameters()));
lm's avatar
lm committed
95
    horizontalLayout->addWidget(setButton, 2, 1);
96

97
    QPushButton* writeButton = new QPushButton(tr("Write (ROM)"));
98 99
    writeButton->setToolTip(tr("Copy current parameters in non-permanent memory of the aircraft to permanent memory. Transmit your parameters first to write these."));
    writeButton->setWhatsThis(tr("Copy current parameters in non-permanent memory of the aircraft to permanent memory. Transmit your parameters first to write these."));
100
    connect(writeButton, SIGNAL(clicked()), this, SLOT(writeParameters()));
lm's avatar
lm committed
101
    horizontalLayout->addWidget(writeButton, 2, 2);
102

103
    QPushButton* loadFileButton = new QPushButton(tr("Load File"));
104 105
    loadFileButton->setToolTip(tr("Load parameters from a file on this computer in the view. To write them to the aircraft, use transmit after loading them."));
    loadFileButton->setWhatsThis(tr("Load parameters from a file on this computer in the view. To write them to the aircraft, use transmit after loading them."));
106
    connect(loadFileButton, SIGNAL(clicked()), this, SLOT(loadParameters()));
lm's avatar
lm committed
107
    horizontalLayout->addWidget(loadFileButton, 3, 0);
108 109

    QPushButton* saveFileButton = new QPushButton(tr("Save File"));
110 111
    saveFileButton->setToolTip(tr("Save parameters in this view to a file on this computer."));
    saveFileButton->setWhatsThis(tr("Save parameters in this view to a file on this computer."));
112
    connect(saveFileButton, SIGNAL(clicked()), this, SLOT(saveParameters()));
lm's avatar
lm committed
113 114 115 116 117 118 119
    horizontalLayout->addWidget(saveFileButton, 3, 1);

    QPushButton* readButton = new QPushButton(tr("Read (ROM)"));
    readButton->setToolTip(tr("Copy parameters from permanent memory to non-permanent current memory of aircraft. DOES NOT update the parameters in this view, click refresh after copying them to get them."));
    readButton->setWhatsThis(tr("Copy parameters from permanent memory to non-permanent current memory of aircraft. DOES NOT update the parameters in this view, click refresh after copying them to get them."));
    connect(readButton, SIGNAL(clicked()), this, SLOT(readParameters()));
    horizontalLayout->addWidget(readButton, 3, 2);
120

121 122 123 124 125 126
    // Set correct vertical scaling
    horizontalLayout->setRowStretch(0, 100);
    horizontalLayout->setRowStretch(1, 10);
    horizontalLayout->setRowStretch(2, 10);
    horizontalLayout->setRowStretch(3, 10);

127
    // Set layout
pixhawk's avatar
pixhawk committed
128 129 130 131 132 133 134 135
    this->setLayout(horizontalLayout);

    // Set header
    QStringList headerItems;
    headerItems.append("Parameter");
    headerItems.append("Value");
    tree->setHeaderLabels(headerItems);
    tree->setColumnCount(2);
136
    tree->setExpandsOnDoubleClick(true);
137 138

    // Connect signals/slots
139
    connect(this, SIGNAL(parameterChanged(int,QString,QVariant)), mav, SLOT(setParameter(int,QString,QVariant)));
140
    connect(tree, SIGNAL(itemChanged(QTreeWidgetItem*,int)), this, SLOT(parameterItemChanged(QTreeWidgetItem*,int)));
lm's avatar
lm committed
141

142
    // New parameters from UAS
143
    connect(uas, SIGNAL(parameterChanged(int,int,int,int,QString,QVariant)), this, SLOT(addParameter(int,int,int,int,QString,QVariant)));
144 145

    // Connect retransmission guard
146
    connect(this, SIGNAL(requestParameter(int,QString)), uas, SLOT(requestParameter(int,QString)));
147 148
    connect(this, SIGNAL(requestParameter(int,int)), uas, SLOT(requestParameter(int,int)));
    connect(&retransmissionTimer, SIGNAL(timeout()), this, SLOT(retransmissionGuardTick()));
149 150

    // Get parameters
151
    if (uas) requestParameterList();
pixhawk's avatar
pixhawk committed
152 153
}

154 155 156 157 158 159 160 161 162 163 164 165
void QGCParamWidget::loadSettings()
{
    QSettings settings;
    settings.beginGroup("QGC_MAVLINK_PROTOCOL");
    bool ok;
    int temp = settings.value("PARAMETER_RETRANSMISSION_TIMEOUT", retransmissionTimeout).toInt(&ok);
    if (ok) retransmissionTimeout = temp;
    temp = settings.value("PARAMETER_REWRITE_TIMEOUT", rewriteTimeout).toInt(&ok);
    if (ok) rewriteTimeout = temp;
    settings.endGroup();
}

lm's avatar
lm committed
166 167
void QGCParamWidget::loadParameterInfoCSV(const QString& autopilot, const QString& airframe)
{
168 169 170 171
    Q_UNUSED(airframe);

    qDebug() << "ATTEMPTING TO LOAD CSV";

LM's avatar
LM committed
172
    QDir appDir = QApplication::applicationDirPath();
173
    appDir.cd("files");
174
    QString fileName = QString("%1/%2/parameter_tooltips/tooltips.txt").arg(appDir.canonicalPath()).arg(autopilot.toLower());
LM's avatar
LM committed
175
    QFile paramMetaFile(fileName);
lm's avatar
lm committed
176

177 178 179
    qDebug() << "AUTOPILOT:" << autopilot;
    qDebug() << "FILENAME: " << fileName;

lm's avatar
lm committed
180 181 182
    // Load CSV data
    if (!paramMetaFile.open(QIODevice::ReadOnly | QIODevice::Text))
    {
183
        //qDebug() << "COULD NOT OPEN PARAM META INFO FILE:" << fileName;
lm's avatar
lm committed
184 185 186 187 188 189 190 191 192 193
        return;
    }

    // Extract header

    // Read in values
    // Find all keys
    QTextStream in(&paramMetaFile);

    // First line is header
194 195
    // there might be more lines, but the first
    // line is assumed to be at least header
lm's avatar
lm committed
196 197
    QString header = in.readLine();

198
    // Ignore top-level comment lines
199 200
    while (header.startsWith('#') || header.startsWith('/')
           || header.startsWith('=') || header.startsWith('^'))
201 202 203 204
    {
        header = in.readLine();
    }

lm's avatar
lm committed
205 206 207 208 209 210
    bool charRead = false;
    QString separator = "";
    QList<QChar> sepCandidates;
    sepCandidates << '\t';
    sepCandidates << ',';
    sepCandidates << ';';
211
    //sepCandidates << ' ';
lm's avatar
lm committed
212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237
    sepCandidates << '~';
    sepCandidates << '|';

    // Iterate until separator is found
    // or full header is parsed
    for (int i = 0; i < header.length(); i++)
    {
        if (sepCandidates.contains(header.at(i)))
        {
            // Separator found
            if (charRead)
            {
                separator += header[i];
            }
        }
        else
        {
            // Char found
            charRead = true;
            // If the separator is not empty, this char
            // has been read after a separator, so detection
            // is now complete
            if (separator != "") break;
        }
    }

238 239 240 241 242 243 244 245 246
    bool stripFirstSeparator = false;
    bool stripLastSeparator = false;

    // Figure out if the lines start with the separator (e.g. wiki syntax)
    if (header.startsWith(separator)) stripFirstSeparator = true;

    // Figure out if the lines end with the separator (e.g. wiki syntax)
    if (header.endsWith(separator)) stripLastSeparator = true;

lm's avatar
lm committed
247 248
    QString out = separator;
    out.replace("\t", "<tab>");
249
    //qDebug() << " Separator: \"" << out << "\"";
lm's avatar
lm committed
250 251 252 253 254 255 256 257
    //qDebug() << "READING CSV:" << header;


    // Read data
    while (!in.atEnd())
    {
        QString line = in.readLine();

258 259 260 261 262 263 264 265
        //qDebug() << "LINE PRE-STRIP" << line;

        // Strip separtors if necessary
        if (stripFirstSeparator) line.remove(0, separator.length());
        if (stripLastSeparator) line.remove(line.length()-separator.length(), line.length()-1);

        //qDebug() << "LINE POST-STRIP" << line;

lm's avatar
lm committed
266 267 268 269 270 271 272 273 274 275 276
        // Keep empty parts here - we still have to act on them
        QStringList parts = line.split(separator, QString::KeepEmptyParts);

        // Each line is:
        // variable name, Min, Max, Default, Multiplier, Enabled (0 = no, 1 = yes), Comment


        // Fill in min, max and default values
        if (parts.count() > 1)
        {
            // min
277
            paramMin.insert(parts.at(0).trimmed(), parts.at(1).toDouble());
lm's avatar
lm committed
278 279 280 281
        }
        if (parts.count() > 2)
        {
            // max
282
            paramMax.insert(parts.at(0).trimmed(), parts.at(2).toDouble());
lm's avatar
lm committed
283 284 285 286
        }
        if (parts.count() > 3)
        {
            // default
287
            paramDefault.insert(parts.at(0).trimmed(), parts.at(3).toDouble());
lm's avatar
lm committed
288 289 290 291 292
        }
        // IGNORING 4 and 5 for now
        if (parts.count() > 6)
        {
            // tooltip
293 294
            paramToolTips.insert(parts.at(0).trimmed(), parts.at(6).trimmed());
            qDebug() << "PARAM META:" << parts.at(0).trimmed();
lm's avatar
lm committed
295 296 297 298
        }
    }
}

299 300 301 302
/**
 * @return The MAV of this widget. Unless the MAV object has been destroyed, this
 *         pointer is never zero.
 */
pixhawk's avatar
pixhawk committed
303 304 305 306 307 308 309 310 311 312 313
UASInterface* QGCParamWidget::getUAS()
{
    return mav;
}

/**
 *
 * @param uas System which has the component
 * @param component id of the component
 * @param componentName human friendly name of the component
 */
314
void QGCParamWidget::addComponent(int uas, int component, QString componentName)
pixhawk's avatar
pixhawk committed
315
{
316
    Q_UNUSED(uas);
317
    if (components->contains(component)) {
pixhawk's avatar
pixhawk committed
318
        // Update existing
319 320 321
        components->value(component)->setData(0, Qt::DisplayRole, QString("%1 (#%2)").arg(componentName).arg(component));
        //components->value(component)->setData(1, Qt::DisplayRole, QString::number(component));
        components->value(component)->setFirstColumnSpanned(true);
322
    } else {
pixhawk's avatar
pixhawk committed
323
        // Add new
lm's avatar
lm committed
324
        QStringList list(QString("%1 (#%2)").arg(componentName).arg(component));
pixhawk's avatar
pixhawk committed
325
        QTreeWidgetItem* comp = new QTreeWidgetItem(list);
lm's avatar
lm committed
326
        comp->setFirstColumnSpanned(true);
pixhawk's avatar
pixhawk committed
327 328 329
        components->insert(component, comp);
        // Create grouping and update maps
        paramGroups.insert(component, new QMap<QString, QTreeWidgetItem*>());
pixhawk's avatar
pixhawk committed
330 331
        tree->addTopLevelItem(comp);
        tree->update();
332
        // Create map in parameters
333
        if (!parameters.contains(component)) {
334
            parameters.insert(component, new QMap<QString, QVariant>());
335 336
        }
        // Create map in changed parameters
337
        if (!changedValues.contains(component)) {
338
            changedValues.insert(component, new QMap<QString, QVariant>());
339
        }
pixhawk's avatar
pixhawk committed
340 341 342
    }
}

lm's avatar
lm committed
343 344 345 346 347
/**
 * @param uas System which has the component
 * @param component id of the component
 * @param parameterName human friendly name of the parameter
 */
348
void QGCParamWidget::addParameter(int uas, int component, int paramCount, int paramId, QString parameterName, QVariant value)
lm's avatar
lm committed
349 350 351
{
    addParameter(uas, component, parameterName, value);

lm's avatar
lm committed
352
    // Missing packets list has to be instantiated for all components
353
    if (!transmissionMissingPackets.contains(component)) {
lm's avatar
lm committed
354 355 356
        transmissionMissingPackets.insert(component, new QList<int>());
    }

lm's avatar
lm committed
357
    // List mode is different from single parameter transfers
358
    if (transmissionListMode) {
lm's avatar
lm committed
359 360
        // Only accept the list size once on the first packet from
        // each component
lm's avatar
lm committed
361 362
        if (!transmissionListSizeKnown.contains(component))
        {
lm's avatar
lm committed
363 364
            // Mark list size as known
            transmissionListSizeKnown.insert(component, true);
lm's avatar
lm committed
365

366
            // Mark all parameters as missing
lm's avatar
lm committed
367 368 369 370
            for (int i = 0; i < paramCount; ++i)
            {
                if (!transmissionMissingPackets.value(component)->contains(i))
                {
lm's avatar
lm committed
371 372 373
                    transmissionMissingPackets.value(component)->append(i);
                }
            }
374

lm's avatar
lm committed
375 376 377
            // There is only one transmission timeout for all components
            // since components do not manage their transmission,
            // the longest timeout is safe for all components.
Lorenz Meier's avatar
Lorenz Meier committed
378
            quint64 thisTransmissionTimeout = QGC::groundTimeMilliseconds() + ((paramCount)*retransmissionTimeout);
lm's avatar
lm committed
379 380
            if (thisTransmissionTimeout > transmissionTimeout)
            {
lm's avatar
lm committed
381 382
                transmissionTimeout = thisTransmissionTimeout;
            }
lm's avatar
lm committed
383
        }
lm's avatar
lm committed
384 385 386 387

        // Start retransmission guard
        // or reset timer
        setRetransmissionGuardEnabled(true);
lm's avatar
lm committed
388 389
    }

lm's avatar
lm committed
390
    // Mark this parameter as received in read list
lm's avatar
lm committed
391 392 393 394
    int index = transmissionMissingPackets.value(component)->indexOf(paramId);
    // If the MAV sent the parameter without request, it wont be in missing list
    if (index != -1) transmissionMissingPackets.value(component)->removeAt(index);

lm's avatar
lm committed
395 396
    bool justWritten = false;
    bool writeMismatch = false;
397
    //bool lastWritten = false;
lm's avatar
lm committed
398
    // Mark this parameter as received in write ACK list
399
    QMap<QString, QVariant>* map = transmissionMissingWriteAckPackets.value(component);
lm's avatar
lm committed
400 401
    if (map && map->contains(parameterName))
    {
lm's avatar
lm committed
402
        justWritten = true;
lm's avatar
lm committed
403 404
        if (map->value(parameterName) != value)
        {
lm's avatar
lm committed
405 406 407 408 409
            writeMismatch = true;
        }
        map->remove(parameterName);
    }

410
    int missCount = 0;
lm's avatar
lm committed
411 412
    foreach (int key, transmissionMissingPackets.keys())
    {
413 414 415
        missCount +=  transmissionMissingPackets.value(key)->count();
    }

lm's avatar
lm committed
416
    int missWriteCount = 0;
lm's avatar
lm committed
417 418
    foreach (int key, transmissionMissingWriteAckPackets.keys())
    {
lm's avatar
lm committed
419 420 421
        missWriteCount += transmissionMissingWriteAckPackets.value(key)->count();
    }

lm's avatar
lm committed
422 423
    if (justWritten && !writeMismatch && missWriteCount == 0)
    {
lm's avatar
lm committed
424 425 426 427 428
        // Just wrote one and count went to 0 - this was the last missing write parameter
        statusLabel->setText(tr("SUCCESS: WROTE ALL PARAMETERS"));
        QPalette pal = statusLabel->palette();
        pal.setColor(backgroundRole(), QGC::colorGreen);
        statusLabel->setPalette(pal);
lm's avatar
lm committed
429 430
    } else if (justWritten && !writeMismatch)
    {
431
        statusLabel->setText(tr("SUCCESS: Wrote %2 (#%1/%4): %3").arg(paramId+1).arg(parameterName).arg(value.toDouble()).arg(paramCount));
lm's avatar
lm committed
432 433 434
        QPalette pal = statusLabel->palette();
        pal.setColor(backgroundRole(), QGC::colorGreen);
        statusLabel->setPalette(pal);
lm's avatar
lm committed
435 436
    } else if (justWritten && writeMismatch)
    {
lm's avatar
lm committed
437
        // Mismatch, tell user
lm's avatar
lm committed
438 439 440
        QPalette pal = statusLabel->palette();
        pal.setColor(backgroundRole(), QGC::colorRed);
        statusLabel->setPalette(pal);
441
        statusLabel->setText(tr("FAILURE: Wrote %1: sent %2 != onboard %3").arg(parameterName).arg(map->value(parameterName).toDouble()).arg(value.toDouble()));
lm's avatar
lm committed
442 443 444 445 446
    }
    else
    {
        if (missCount > 0)
        {
lm's avatar
lm committed
447 448 449
            QPalette pal = statusLabel->palette();
            pal.setColor(backgroundRole(), QGC::colorOrange);
            statusLabel->setPalette(pal);
lm's avatar
lm committed
450 451 452
        }
        else
        {
lm's avatar
lm committed
453 454 455 456
            QPalette pal = statusLabel->palette();
            pal.setColor(backgroundRole(), QGC::colorGreen);
            statusLabel->setPalette(pal);
        }
457 458
        QString val = QString("%1").arg(value.toFloat(), 5, 'f', 1, QChar(' '));
        //statusLabel->setText(tr("OK: %1 %2 #%3/%4, %5 miss").arg(parameterName).arg(val).arg(paramId+1).arg(paramCount).arg(missCount));
459 460 461 462 463 464 465 466 467 468 469 470
        if (missCount == 0)
        {
            // Transmission done
            QTime time = QTime::currentTime();
            QString timeString = time.toString();
            statusLabel->setText(tr("All received. (updated at %1)").arg(timeString));
        }
        else
        {
            // Transmission in progress
            statusLabel->setText(tr("OK: %1 %2 (%3/%4)").arg(parameterName).arg(val).arg(paramCount-missCount).arg(paramCount));
        }
lm's avatar
lm committed
471
    }
lm's avatar
lm committed
472 473

    // Check if last parameter was received
lm's avatar
lm committed
474 475
    if (missCount == 0 && missWriteCount == 0)
    {
lm's avatar
lm committed
476 477 478
        this->transmissionActive = false;
        this->transmissionListMode = false;
        transmissionListSizeKnown.clear();
lm's avatar
lm committed
479 480
        foreach (int key, transmissionMissingPackets.keys())
        {
lm's avatar
lm committed
481 482
            transmissionMissingPackets.value(key)->clear();
        }
483 484 485

        // Expand visual tree
        tree->expandItem(tree->topLevelItem(0));
lm's avatar
lm committed
486 487 488
    }
}

489 490 491 492 493
/**
 * @param uas System which has the component
 * @param component id of the component
 * @param parameterName human friendly name of the parameter
 */
494
void QGCParamWidget::addParameter(int uas, int component, QString parameterName, QVariant value)
pixhawk's avatar
pixhawk committed
495
{
496
    //qDebug() << "PARAM WIDGET GOT PARAM:" << value;
497
    Q_UNUSED(uas);
498
    // Reference to item in tree
499
    QTreeWidgetItem* parameterItem = NULL;
pixhawk's avatar
pixhawk committed
500 501

    // Get component
lm's avatar
lm committed
502 503
    if (!components->contains(component))
    {
Lorenz Meier's avatar
Lorenz Meier committed
504 505 506 507 508 509 510 511 512 513 514 515 516
        //        QString componentName;
        //        switch (component)
        //        {
        //        case MAV_COMP_ID_CAMERA:
        //            componentName = tr("Camera (#%1)").arg(component);
        //            break;
        //        case MAV_COMP_ID_IMU:
        //            componentName = tr("IMU (#%1)").arg(component);
        //            break;
        //        default:
        //            componentName = tr("Component #").arg(component);
        //            break;
        //        }
517
        QString componentName = tr("Component #%1").arg(component);
518
        addComponent(uas, component, componentName);
pixhawk's avatar
pixhawk committed
519
    }
520

521 522 523 524 525 526 527
    // Replace value in map

    // FIXME
    if (parameters.value(component)->contains(parameterName)) parameters.value(component)->remove(parameterName);
    parameters.value(component)->insert(parameterName, value);


pixhawk's avatar
pixhawk committed
528 529
    QString splitToken = "_";
    // Check if auto-grouping can work
lm's avatar
lm committed
530 531
    if (parameterName.contains(splitToken))
    {
pixhawk's avatar
pixhawk committed
532 533
        QString parent = parameterName.section(splitToken, 0, 0, QString::SectionSkipEmpty);
        QMap<QString, QTreeWidgetItem*>* compParamGroups = paramGroups.value(component);
534 535
        if (!compParamGroups->contains(parent))
        {
pixhawk's avatar
pixhawk committed
536 537 538 539 540 541
            // Insert group item
            QStringList glist;
            glist.append(parent);
            QTreeWidgetItem* item = new QTreeWidgetItem(glist);
            compParamGroups->insert(parent, item);
            components->value(component)->addChild(item);
542
        }
543 544 545 546

        // Append child to group
        bool found = false;
        QTreeWidgetItem* parentItem = compParamGroups->value(parent);
547
        for (int i = 0; i < parentItem->childCount(); i++) {
548 549
            QTreeWidgetItem* child = parentItem->child(i);
            QString key = child->data(0, Qt::DisplayRole).toString();
550 551
            if (key == parameterName)
            {
552 553 554 555 556 557 558
                //qDebug() << "UPDATED CHILD";
                parameterItem = child;
                parameterItem->setData(1, Qt::DisplayRole, value);
                found = true;
            }
        }

lm's avatar
lm committed
559 560
        if (!found)
        {
561 562 563
            // Insert parameter into map
            QStringList plist;
            plist.append(parameterName);
564
            // CREATE PARAMETER ITEM
565
            parameterItem = new QTreeWidgetItem(plist);
566
            // CONFIGURE PARAMETER ITEM
567
            parameterItem->setData(1, Qt::DisplayRole, value);
568 569

            compParamGroups->value(parent)->addChild(parameterItem);
lm's avatar
lm committed
570
            parameterItem->setFlags(parameterItem->flags() | Qt::ItemIsEditable);
571
        }
lm's avatar
lm committed
572 573 574
    }
    else
    {
pixhawk's avatar
pixhawk committed
575 576
        bool found = false;
        QTreeWidgetItem* parent = components->value(component);
lm's avatar
lm committed
577 578
        for (int i = 0; i < parent->childCount(); i++)
        {
pixhawk's avatar
pixhawk committed
579 580
            QTreeWidgetItem* child = parent->child(i);
            QString key = child->data(0, Qt::DisplayRole).toString();
lm's avatar
lm committed
581 582
            if (key == parameterName)
            {
pixhawk's avatar
pixhawk committed
583
                //qDebug() << "UPDATED CHILD";
584 585
                parameterItem = child;
                parameterItem->setData(1, Qt::DisplayRole, value);
pixhawk's avatar
pixhawk committed
586 587 588 589
                found = true;
            }
        }

lm's avatar
lm committed
590 591
        if (!found)
        {
592 593 594
            // Insert parameter into map
            QStringList plist;
            plist.append(parameterName);
595
            // CREATE PARAMETER ITEM
596
            parameterItem = new QTreeWidgetItem(plist);
597
            // CONFIGURE PARAMETER ITEM
598
            parameterItem->setData(1, Qt::DisplayRole, value);
599

lm's avatar
lm committed
600 601
            components->value(component)->addChild(parameterItem);
            parameterItem->setFlags(parameterItem->flags() | Qt::ItemIsEditable);
pixhawk's avatar
pixhawk committed
602
        }
603
        //tree->expandAll();
604
    }
605
    // Reset background color
606
    parameterItem->setBackground(0, Qt::NoBrush);
607
    parameterItem->setBackground(1, Qt::NoBrush);
lm's avatar
lm committed
608
    // Add tooltip
609 610 611 612
    QString tooltipFormat;
    if (paramDefault.contains(parameterName))
    {
        tooltipFormat = tr("Default: %1, %2");
LM's avatar
LM committed
613
        tooltipFormat = tooltipFormat.arg(paramDefault.value(parameterName, 0.0f)).arg(paramToolTips.value(parameterName, ""));
614 615 616 617 618 619 620
    }
    else
    {
        tooltipFormat = paramToolTips.value(parameterName, "");
    }
    parameterItem->setToolTip(0, tooltipFormat);
    parameterItem->setToolTip(1, tooltipFormat);
lm's avatar
lm committed
621

622
    //tree->update();
pixhawk's avatar
pixhawk committed
623
    if (changedValues.contains(component)) changedValues.value(component)->remove(parameterName);
pixhawk's avatar
pixhawk committed
624 625
}

626 627 628 629
/**
 * Send a request to deliver the list of onboard parameters
 * to the MAV.
 */
630 631
void QGCParamWidget::requestParameterList()
{
632
    if (!mav) return;
633 634 635 636 637 638 639
    // FIXME This call does not belong here
    // Once the comm handling is moved to a new
    // Param manager class the settings can be directly
    // loaded from MAVLink protocol
    loadSettings();
    // End of FIXME

lm's avatar
lm committed
640
    // Clear view and request param list
641
    clear();
642
    parameters.clear();
lm's avatar
lm committed
643
    received.clear();
lm's avatar
lm committed
644 645 646
    // Clear transmission state
    transmissionListMode = true;
    transmissionListSizeKnown.clear();
Lorenz Meier's avatar
Lorenz Meier committed
647 648
    foreach (int key, transmissionMissingPackets.keys())
    {
lm's avatar
lm committed
649 650 651
        transmissionMissingPackets.value(key)->clear();
    }
    transmissionActive = true;
lm's avatar
lm committed
652 653 654 655 656

    // Set status text
    statusLabel->setText(tr("Requested param list.. waiting"));

    mav->requestParameters();
657 658
}

659
void QGCParamWidget::parameterItemChanged(QTreeWidgetItem* current, int column)
lm's avatar
lm committed
660
{
661
    if (current && column > 0) {
662
        QTreeWidgetItem* parent = current->parent();
663
        while (parent->parent() != NULL) {
664 665 666 667
            parent = parent->parent();
        }
        // Parent is now top-level component
        int key = components->key(parent);
668
        if (!changedValues.contains(key)) {
669
            changedValues.insert(key, new QMap<QString, QVariant>());
670
        }
671
        QMap<QString, QVariant>* map = changedValues.value(key, NULL);
672
        if (map) {
673
            QString str = current->data(0, Qt::DisplayRole).toString();
674
            QVariant value = current->data(1, Qt::DisplayRole);
lm's avatar
lm committed
675
            // Set parameter on changed list to be transmitted to MAV
676 677 678 679
            QPalette pal = statusLabel->palette();
            pal.setColor(backgroundRole(), QGC::colorOrange);
            statusLabel->setPalette(pal);
            statusLabel->setText(tr("Transmit pend. %1:%2: %3").arg(key).arg(str).arg(value.toFloat(), 5, 'f', 1, QChar(' ')));
680 681 682 683 684 685 686 687 688 689
            //qDebug() << "PARAM CHANGED: COMP:" << key << "KEY:" << str << "VALUE:" << value;
            // Changed values list
            if (map->contains(str)) map->remove(str);
            map->insert(str, value);

            // Check if the value was numerically changed
            if (!parameters.value(key)->contains(str) || parameters.value(key)->value(str, value.toDouble()-1) != value) {
                current->setBackground(0, QBrush(QColor(QGC::colorOrange)));
                current->setBackground(1, QBrush(QColor(QGC::colorOrange)));
            }
690

691 692 693
            switch (parameters.value(key)->value(str).type())
            {
            case QVariant::Int:
Lorenz Meier's avatar
Lorenz Meier committed
694 695 696 697
            {
                QVariant fixedValue(value.toInt());
                parameters.value(key)->insert(str, fixedValue);
            }
698 699
                break;
            case QVariant::UInt:
Lorenz Meier's avatar
Lorenz Meier committed
700 701 702 703
            {
                QVariant fixedValue(value.toUInt());
                parameters.value(key)->insert(str, fixedValue);
            }
704 705
                break;
            case QMetaType::Float:
Lorenz Meier's avatar
Lorenz Meier committed
706 707 708 709
            {
                QVariant fixedValue(value.toFloat());
                parameters.value(key)->insert(str, fixedValue);
            }
710 711 712 713
                break;
            default:
                qCritical() << "ABORTED PARAM UPDATE, NO VALID QVARIANT TYPE";
                return;
714 715 716 717 718 719
            }
        }
    }
}

void QGCParamWidget::saveParameters()
720
{
721
    if (!mav) return;
722 723
    QString fileName = QFileDialog::getSaveFileName(this, tr("Save File"), "./parameters.txt", tr("Parameter File (*.txt)"));
    QFile file(fileName);
724
    if (!file.open(QIODevice::WriteOnly | QIODevice::Text)) {
725 726 727 728 729 730 731 732 733 734
        return;
    }

    QTextStream in(&file);

    in << "# Onboard parameters for system " << mav->getUASName() << "\n";
    in << "#\n";
    in << "# MAV ID  COMPONENT ID  PARAM NAME  VALUE (FLOAT)\n";

    // Iterate through all components, through all parameters and emit them
735
    QMap<int, QMap<QString, QVariant>*>::iterator i;
736
    for (i = parameters.begin(); i != parameters.end(); ++i) {
737 738
        // Iterate through the parameters of the component
        int compid = i.key();
739
        QMap<QString, QVariant>* comp = i.value();
740
        {
741 742 743
            QMap<QString, QVariant>::iterator j;
            for (j = comp->begin(); j != comp->end(); ++j)
            {
744
                QString paramValue("%1");
745 746 747 748 749
                QString paramType("%1");
                switch (j.value().type())
                {
                case QVariant::Int:
                    paramValue = paramValue.arg(j.value().toInt());
750
                    paramType = paramType.arg(MAV_PARAM_TYPE_INT32);
751 752 753
                    break;
                case QVariant::UInt:
                    paramValue = paramValue.arg(j.value().toUInt());
754
                    paramType = paramType.arg(MAV_PARAM_TYPE_UINT32);
755 756 757
                    break;
                case QMetaType::Float:
                    paramValue = paramValue.arg(j.value().toDouble(), 25, 'g', 12);
758
                    paramType = paramType.arg(MAV_PARAM_TYPE_REAL32);
759 760 761 762 763 764
                    break;
                default:
                    qCritical() << "ABORTED PARAM WRITE TO FILE, NO VALID QVARIANT TYPE" << j.value();
                    return;
                }
                in << mav->getUASID() << "\t" << compid << "\t" << j.key() << "\t" << paramValue << "\t" << paramType << "\n";
765 766 767 768 769 770 771 772 773
                in.flush();
            }
        }
    }
    file.close();
}

void QGCParamWidget::loadParameters()
{
774
    if (!mav) return;
775 776 777 778 779
    QString fileName = QFileDialog::getOpenFileName(this, tr("Load File"), ".", tr("Parameter file (*.txt)"));
    QFile file(fileName);
    if (!file.open(QIODevice::ReadOnly | QIODevice::Text))
        return;

Lorenz Meier's avatar
Lorenz Meier committed
780
    bool userWarned = false;
781 782

    QTextStream in(&file);
783
    while (!in.atEnd()) {
784
        QString line = in.readLine();
785
        if (!line.startsWith("#")) {
786
            QStringList wpParams = line.split("\t");
787
            if (wpParams.size() == 5) {
788
                // Only load parameters for right mav
Lorenz Meier's avatar
Lorenz Meier committed
789 790 791 792
                if (!userWarned && (mav->getUASID() != wpParams.at(0).toInt())) {
                    MainWindow::instance()->showCriticalMessage(tr("Parameter loading warning"), tr("The parameters from the file %1 have been saved from system %2, but the currently selected system has the ID %3. If this is unintentional, please click on <READ> to revert to the parameters that are currently onboard").arg(fileName).arg(wpParams.at(0).toInt()).arg(mav->getUASID()));
                    userWarned = true;
                }
pixhawk's avatar
pixhawk committed
793

Lorenz Meier's avatar
Lorenz Meier committed
794 795 796 797 798 799 800 801
                bool changed = false;
                int component = wpParams.at(1).toInt();
                QString parameterName = wpParams.at(2);
                if (!parameters.contains(component) ||
                        fabs((static_cast<float>(parameters.value(component)->value(parameterName, wpParams.at(3).toDouble()).toDouble())) - (wpParams.at(3).toDouble())) > 2.0f * FLT_EPSILON) {
                    changed = true;
                    qDebug() << "Changed" << parameterName << "VAL" << wpParams.at(3).toDouble();
                }
lm's avatar
lm committed
802

Lorenz Meier's avatar
Lorenz Meier committed
803
                // Set parameter value
lm's avatar
lm committed
804

Lorenz Meier's avatar
Lorenz Meier committed
805 806 807 808
                // Create changed values data structure if necessary
                if (changed && !changedValues.contains(wpParams.at(1).toInt())) {
                    changedValues.insert(wpParams.at(1).toInt(), new QMap<QString, QVariant>());
                }
pixhawk's avatar
pixhawk committed
809

Lorenz Meier's avatar
Lorenz Meier committed
810 811 812 813
                // Add to changed values
                if (changed && changedValues.value(wpParams.at(1).toInt())->contains(wpParams.at(2))) {
                    changedValues.value(wpParams.at(1).toInt())->remove(wpParams.at(2));
                }
pixhawk's avatar
pixhawk committed
814

Lorenz Meier's avatar
Lorenz Meier committed
815 816 817 818 819 820 821 822
                switch (wpParams.at(4).toUInt())
                {
                case (int)MAV_PARAM_TYPE_REAL32:
                    addParameter(wpParams.at(0).toInt(), wpParams.at(1).toInt(), wpParams.at(2), wpParams.at(3).toFloat());
                    if (changed) {
                        changedValues.value(wpParams.at(1).toInt())->insert(wpParams.at(2), wpParams.at(3).toFloat());
                        setParameter(wpParams.at(1).toInt(), wpParams.at(2), wpParams.at(3).toFloat());
                        qDebug() << "FLOAT PARAM CHANGED";
823
                    }
Lorenz Meier's avatar
Lorenz Meier committed
824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840
                    break;
                case (int)MAV_PARAM_TYPE_UINT32:
                    addParameter(wpParams.at(0).toInt(), wpParams.at(1).toInt(), wpParams.at(2), wpParams.at(3).toUInt());
                    if (changed) {
                        changedValues.value(wpParams.at(1).toInt())->insert(wpParams.at(2), wpParams.at(3).toUInt());
                        setParameter(wpParams.at(1).toInt(), wpParams.at(2), QVariant(wpParams.at(3).toUInt()));
                    }
                    break;
                case (int)MAV_PARAM_TYPE_INT32:
                    addParameter(wpParams.at(0).toInt(), wpParams.at(1).toInt(), wpParams.at(2), wpParams.at(3).toInt());
                    if (changed) {
                        changedValues.value(wpParams.at(1).toInt())->insert(wpParams.at(2), wpParams.at(3).toInt());
                        setParameter(wpParams.at(1).toInt(), wpParams.at(2), QVariant(wpParams.at(3).toInt()));
                    }
                    break;
                default:
                    qDebug() << "FAILED LOADING PARAM" << wpParams.at(2) << "NO KNOWN DATA TYPE";
841
                }
Lorenz Meier's avatar
Lorenz Meier committed
842 843 844 845 846 847

                //qDebug() << "MARKING COMP" << wpParams.at(1).toInt() << "PARAM" << wpParams.at(2) << "VALUE" << (float)wpParams.at(3).toDouble() << "AS CHANGED";

                // Mark in UI


lm's avatar
lm committed
848 849
            }
        }
850
    }
851 852
    file.close();

lm's avatar
lm committed
853 854
}

855 856 857 858 859 860 861 862 863
/**
 * Enabling the retransmission guard enables the parameter widget to track
 * dropped parameters and to re-request them. This works for both individual
 * parameter reads as well for whole list requests.
 *
 * @param enabled True if retransmission checking should be enabled, false else
 */
void QGCParamWidget::setRetransmissionGuardEnabled(bool enabled)
{
864
    if (enabled) {
865
        retransmissionTimer.start(retransmissionTimeout);
866
    } else {
867 868 869 870 871 872
        retransmissionTimer.stop();
    }
}

void QGCParamWidget::retransmissionGuardTick()
{
873
    if (transmissionActive) {
874
        //qDebug() << __FILE__ << __LINE__ << "RETRANSMISSION GUARD ACTIVE, CHECKING FOR DROPS..";
875

lm's avatar
lm committed
876 877
        // Check for timeout
        // stop retransmission attempts on timeout
878
        if (QGC::groundTimeMilliseconds() > transmissionTimeout) {
lm's avatar
lm committed
879 880 881 882 883 884 885
            setRetransmissionGuardEnabled(false);
            transmissionActive = false;

            // Empty read retransmission list
            // Empty write retransmission list
            int missingReadCount = 0;
            QList<int> readKeys = transmissionMissingPackets.keys();
886
            foreach (int component, readKeys) {
lm's avatar
lm committed
887 888 889 890 891 892 893
                missingReadCount += transmissionMissingPackets.value(component)->count();
                transmissionMissingPackets.value(component)->clear();
            }

            // Empty write retransmission list
            int missingWriteCount = 0;
            QList<int> writeKeys = transmissionMissingWriteAckPackets.keys();
894
            foreach (int component, writeKeys) {
lm's avatar
lm committed
895 896 897 898 899 900 901 902
                missingWriteCount += transmissionMissingWriteAckPackets.value(component)->count();
                transmissionMissingWriteAckPackets.value(component)->clear();
            }
            statusLabel->setText(tr("TIMEOUT! MISSING: %1 read, %2 write.").arg(missingReadCount).arg(missingWriteCount));
        }

        // Re-request at maximum retransmissionBurstRequestSize parameters at once
        // to prevent link flooding
903
        QMap<int, QMap<QString, QVariant>*>::iterator i;
904
        for (i = parameters.begin(); i != parameters.end(); ++i) {
905 906
            // Iterate through the parameters of the component
            int component = i.key();
lm's avatar
lm committed
907
            // Request n parameters from this component (at maximum)
908
            QList<int> * paramList = transmissionMissingPackets.value(component, NULL);
909
            if (paramList) {
910
                int count = 0;
911 912
                foreach (int id, *paramList) {
                    if (count < retransmissionBurstRequestSize) {
913
                        //qDebug() << __FILE__ << __LINE__ << "RETRANSMISSION GUARD REQUESTS RETRANSMISSION OF PARAM #" << id << "FROM COMPONENT #" << component;
914
                        emit requestParameter(component, id);
lm's avatar
lm committed
915
                        statusLabel->setText(tr("Requested retransmission of #%1").arg(id+1));
916
                        count++;
917
                    } else {
918 919 920 921 922
                        break;
                    }
                }
            }
        }
lm's avatar
lm committed
923 924 925 926 927

        // Re-request at maximum retransmissionBurstRequestSize parameters at once
        // to prevent write-request link flooding
        // Empty write retransmission list
        QList<int> writeKeys = transmissionMissingWriteAckPackets.keys();
928
        foreach (int component, writeKeys) {
lm's avatar
lm committed
929
            int count = 0;
930
            QMap <QString, QVariant>* missingParams = transmissionMissingWriteAckPackets.value(component);
931 932
            foreach (QString key, missingParams->keys()) {
                if (count < retransmissionBurstRequestSize) {
lm's avatar
lm committed
933
                    // Re-request write operation
934 935 936 937
                    QVariant value = missingParams->value(key);
                    switch (parameters.value(component)->value(key).type())
                    {
                    case QVariant::Int:
Lorenz Meier's avatar
Lorenz Meier committed
938 939 940 941
                    {
                        QVariant fixedValue(value.toInt());
                        emit parameterChanged(component, key, fixedValue);
                    }
942 943
                        break;
                    case QVariant::UInt:
Lorenz Meier's avatar
Lorenz Meier committed
944 945 946 947
                    {
                        QVariant fixedValue(value.toUInt());
                        emit parameterChanged(component, key, fixedValue);
                    }
948 949
                        break;
                    case QMetaType::Float:
Lorenz Meier's avatar
Lorenz Meier committed
950 951 952 953
                    {
                        QVariant fixedValue(value.toFloat());
                        emit parameterChanged(component, key, fixedValue);
                    }
954 955
                        break;
                    default:
956
                        //qCritical() << "ABORTED PARAM RETRANSMISSION, NO VALID QVARIANT TYPE";
957 958
                        return;
                    }
959
                    statusLabel->setText(tr("Requested rewrite of: %1: %2").arg(key).arg(missingParams->value(key).toDouble()));
lm's avatar
lm committed
960
                    count++;
961
                } else {
lm's avatar
lm committed
962 963 964 965
                    break;
                }
            }
        }
966
    } else {
967
        //qDebug() << __FILE__ << __LINE__ << "STOPPING RETRANSMISSION GUARD GRACEFULLY";
968 969 970 971
        setRetransmissionGuardEnabled(false);
    }
}

972

973 974 975 976 977
/**
 * The .. signal is emitted
 */
void QGCParamWidget::requestParameterUpdate(int component, const QString& parameter)
{
978
    if (mav) mav->requestParameter(component, parameter);
979 980 981
}


982 983 984 985 986
/**
 * @param component the subsystem which has the parameter
 * @param parameterName name of the parameter, as delivered by the system
 * @param value value of the parameter
 */
987
void QGCParamWidget::setParameter(int component, QString parameterName, QVariant value)
988
{
989 990 991 992 993 994 995 996 997 998
    if (paramMin.contains(parameterName) && value.toDouble() < paramMin.value(parameterName))
    {
        statusLabel->setText(tr("REJ. %1 < min").arg(value.toDouble()));
        return;
    }
    if (paramMax.contains(parameterName) && value.toDouble() > paramMax.value(parameterName))
    {
        statusLabel->setText(tr("REJ. %1 > max").arg(value.toDouble()));
        return;
    }
999 1000 1001 1002

    switch (parameters.value(component)->value(parameterName).type())
    {
    case QVariant::Int:
Lorenz Meier's avatar
Lorenz Meier committed
1003 1004 1005 1006 1007
    {
        QVariant fixedValue(value.toInt());
        emit parameterChanged(component, parameterName, fixedValue);
        //qDebug() << "PARAM WIDGET SENT:" << fixedValue;
    }
1008 1009
        break;
    case QVariant::UInt:
Lorenz Meier's avatar
Lorenz Meier committed
1010 1011 1012 1013 1014
    {
        QVariant fixedValue(value.toUInt());
        emit parameterChanged(component, parameterName, fixedValue);
        //qDebug() << "PARAM WIDGET SENT:" << fixedValue;
    }
1015 1016
        break;
    case QMetaType::Float:
Lorenz Meier's avatar
Lorenz Meier committed
1017 1018 1019 1020 1021
    {
        QVariant fixedValue(value.toFloat());
        emit parameterChanged(component, parameterName, fixedValue);
        //qDebug() << "PARAM WIDGET SENT:" << fixedValue;
    }
1022 1023 1024 1025 1026 1027
        break;
    default:
        qCritical() << "ABORTED PARAM SEND, NO VALID QVARIANT TYPE";
        return;
    }

lm's avatar
lm committed
1028 1029
    // Wait for parameter to be written back
    // mark it therefore as missing
1030 1031 1032
    if (!transmissionMissingWriteAckPackets.contains(component))
    {
        transmissionMissingWriteAckPackets.insert(component, new QMap<QString, QVariant>());
lm's avatar
lm committed
1033 1034 1035 1036 1037 1038
    }

    // Insert it in missing write ACK list
    transmissionMissingWriteAckPackets.value(component)->insert(parameterName, value);

    // Set timeouts
Lorenz Meier's avatar
Lorenz Meier committed
1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050
    if (transmissionActive)
    {
        transmissionTimeout += rewriteTimeout;
    }
    else
    {
        quint64 newTransmissionTimeout = QGC::groundTimeMilliseconds() + rewriteTimeout;
        if (newTransmissionTimeout > transmissionTimeout)
        {
            transmissionTimeout = newTransmissionTimeout;
        }
        transmissionActive = true;
lm's avatar
lm committed
1051
    }
Lorenz Meier's avatar
Lorenz Meier committed
1052

lm's avatar
lm committed
1053 1054
    // Enable guard / reset timeouts
    setRetransmissionGuardEnabled(true);
1055 1056
}

1057 1058 1059
/**
 * Set all parameter in the parameter tree on the MAV
 */
1060 1061
void QGCParamWidget::setParameters()
{
1062
    // Iterate through all components, through all parameters and emit them
1063
    int parametersSent = 0;
1064
    QMap<int, QMap<QString, QVariant>*>::iterator i;
1065
    for (i = changedValues.begin(); i != changedValues.end(); ++i) {
1066 1067
        // Iterate through the parameters of the component
        int compid = i.key();
1068
        QMap<QString, QVariant>* comp = i.value();
1069
        {
1070
            QMap<QString, QVariant>::iterator j;
1071
            for (j = comp->begin(); j != comp->end(); ++j) {
1072
                setParameter(compid, j.key(), j.value());
1073
                parametersSent++;
1074 1075 1076 1077
            }
        }
    }

lm's avatar
lm committed
1078
    // Change transmission status if necessary
1079
    if (parametersSent == 0) {
1080
        statusLabel->setText(tr("No transmission: No changed values."));
1081
    } else {
1082
        statusLabel->setText(tr("Transmitting %1 parameters.").arg(parametersSent));
lm's avatar
lm committed
1083
        // Set timeouts
Lorenz Meier's avatar
Lorenz Meier committed
1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094
        if (transmissionActive)
        {
            transmissionTimeout += parametersSent*rewriteTimeout;
        }
        else
        {
            transmissionActive = true;
            quint64 newTransmissionTimeout = QGC::groundTimeMilliseconds() + parametersSent*rewriteTimeout;
            if (newTransmissionTimeout > transmissionTimeout) {
                transmissionTimeout = newTransmissionTimeout;
            }
lm's avatar
lm committed
1095 1096 1097
        }
        // Enable guard
        setRetransmissionGuardEnabled(true);
1098
    }
1099 1100
}

1101 1102 1103 1104
/**
 * Write the current onboard parameters from RAM into
 * permanent storage, e.g. EEPROM or harddisk
 */
1105 1106
void QGCParamWidget::writeParameters()
{
1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133
    int changedParamCount = 0;

    QMap<int, QMap<QString, QVariant>*>::iterator i;
    for (i = changedValues.begin(); i != changedValues.end(); ++i)
    {
        // Iterate through the parameters of the component
        QMap<QString, QVariant>* comp = i.value();
        {
            QMap<QString, QVariant>::iterator j;
            for (j = comp->begin(); j != comp->end(); ++j)
            {
                changedParamCount++;
            }
        }
    }

    if (changedParamCount > 0)
    {
        QMessageBox msgBox;
        msgBox.setText(tr("There are locally changed parameters. Please transmit them first (<TRANSMIT>) or update them with the onboard values (<REFRESH>) before storing onboard from RAM to ROM."));
        msgBox.exec();
    }
    else
    {
        if (!mav) return;
        mav->writeParametersToStorage();
    }
1134 1135 1136 1137
}

void QGCParamWidget::readParameters()
{
1138
    if (!mav) return;
1139
    mav->readParametersFromStorage();
1140 1141
}

1142 1143 1144
/**
 * Clear all data in the parameter widget
 */
pixhawk's avatar
pixhawk committed
1145 1146 1147
void QGCParamWidget::clear()
{
    tree->clear();
lm's avatar
lm committed
1148
    components->clear();
pixhawk's avatar
pixhawk committed
1149
}