MAVLinkSystem.cc

Go to the documentation of this file.

#include "MAVLinkSystem.h"
#include "MAVLinkMessage.h"
#include "QGCLoggingCategory.h"
 
QGC_LOGGING_CATEGORY(MAVLinkSystemLog, "AnalyzeView.MAVLinkSystem")
 
QGCMAVLinkSystem::QGCMAVLinkSystem(quint8 id, QObject *parent)
    : QObject(parent)
    , _systemID(id)
    , _messages(new QmlObjectListModel(this))
{
    qCDebug(MAVLinkSystemLog) << "New Vehicle:" << id;
}
 
QGCMAVLinkSystem::~QGCMAVLinkSystem()
{
    _messages->clearAndDeleteContents();
}
 
QGCMAVLinkMessage *QGCMAVLinkSystem::findMessage(uint32_t id, uint8_t compId)
{
    for (int i = 0; i < _messages->count(); i++) {
        QGCMAVLinkMessage *const msg = qobject_cast<QGCMAVLinkMessage*>(_messages->get(i));
        if(msg) {
            if((msg->id() == id) && (msg->compId() == compId)) {
                return msg;
            }
        }
    }
 
    return nullptr;
}
 
int QGCMAVLinkSystem::findMessage(const QGCMAVLinkMessage *message)
{
    for (int i = 0; i < _messages->count(); i++) {
        const QGCMAVLinkMessage *const msg = qobject_cast<const QGCMAVLinkMessage*>(_messages->get(i));
        if (msg && (msg == message)) {
            return i;
        }
    }
 
    return -1;
}
 
void QGCMAVLinkSystem::_resetSelection()
{
    for (int i = 0; i < _messages->count(); i++) {
        QGCMAVLinkMessage *const msg = qobject_cast<QGCMAVLinkMessage*>(_messages->get(i));
        if (msg && msg->selected()) {
            msg->setSelected(false);
            emit msg->selectedChanged();
        }
    }
}
 
void QGCMAVLinkSystem::setSelected(int sel)
{
    if (sel >= _messages->count()) {
        return;
    }
 
    _selected = sel;
    emit selectedChanged();
    _resetSelection();
    QGCMAVLinkMessage *const msg = qobject_cast<QGCMAVLinkMessage*>(_messages->get(sel));
    if(msg && !msg->selected()) {
        msg->setSelected(true);
        emit msg->selectedChanged();
    }
}
 
QGCMAVLinkMessage *QGCMAVLinkSystem::selectedMsg()
{
    QGCMAVLinkMessage *selectedMsg = nullptr;
    if (_messages->count()) {
        selectedMsg = qobject_cast<QGCMAVLinkMessage*>(_messages->get(_selected));
    }
 
    return selectedMsg;
}
 
static bool messages_sort(const QObject *a, const QObject *b)
{
    const QGCMAVLinkMessage *const aa = qobject_cast<const QGCMAVLinkMessage*>(a);
    const QGCMAVLinkMessage *const bb = qobject_cast<const QGCMAVLinkMessage*>(b);
    if (!aa || !bb) {
        return false;
    }
 
    if (aa->name() == bb->name()) {
        return (aa->name() < bb->name());
    }
 
    return (aa->name() < bb->name());
}
 
void QGCMAVLinkSystem::append(QGCMAVLinkMessage *message)
{
    QGCMAVLinkMessage *selectedMsg = nullptr;
    if (_messages->count()) {
        selectedMsg = qobject_cast<QGCMAVLinkMessage*>(_messages->get(_selected));
    } else {
        message->setSelected(true);
    }
    _messages->append(message);
 
    if (_messages->count() > 0) {
        _messages->beginResetModel();
        std::sort(_messages->objectList()->begin(), _messages->objectList()->end(), messages_sort);
        _messages->endResetModel();
        _checkCompID(message);
    }
 
    if (selectedMsg) {
        const int idx = findMessage(selectedMsg);
        if (idx >= 0) {
            _selected = idx;
            emit selectedChanged();
        }
    }
}
 
void QGCMAVLinkSystem::_checkCompID(const QGCMAVLinkMessage *message)
{
    if (_compIDsStr.isEmpty()) {
        _compIDsStr << tr("Comp All");
    }
 
    if (!_compIDs.contains(static_cast<int>(message->compId()))) {
        const int compId = static_cast<int>(message->compId());
        _compIDs.append(compId);
        _compIDsStr << tr("Comp %1").arg(compId);
        emit compIDsChanged();
    }
}