LinkManager.cc 5.48 KB
Newer Older
pixhawk's avatar
pixhawk committed
1
/*=====================================================================
lm's avatar
lm committed
2 3 4 5 6 7 8 9

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
pixhawk's avatar
pixhawk committed
10 11 12
    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.
lm's avatar
lm committed
13 14

    QGROUNDCONTROL is distributed in the hope that it will be useful,
pixhawk's avatar
pixhawk committed
15 16 17
    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.
lm's avatar
lm committed
18

pixhawk's avatar
pixhawk committed
19
    You should have received a copy of the GNU General Public License
lm's avatar
lm committed
20 21
    along with QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.

pixhawk's avatar
pixhawk committed
22
======================================================================*/
23

pixhawk's avatar
pixhawk committed
24 25 26 27 28 29 30 31 32 33 34
/**
 * @file
 *   @brief Brief Description
 *
 *   @author Lorenz Meier <mavteam@student.ethz.ch>
 *
 */

#include <QList>
#include <QApplication>
#include "LinkManager.h"
35
#include <iostream>
pixhawk's avatar
pixhawk committed
36

37 38
#include <QDebug>

39 40 41 42 43 44 45 46 47 48 49
LinkManager* LinkManager::instance()
{
    static LinkManager* _instance = 0;
    if(_instance == 0) {
        _instance = new LinkManager();

        /* Set the application as parent to ensure that this object
         * will be destroyed when the main application exits */
        _instance->setParent(qApp);
    }
    return _instance;
pixhawk's avatar
pixhawk committed
50 51 52 53
}

/**
 * @brief Private singleton constructor
54
 *
pixhawk's avatar
pixhawk committed
55 56 57 58
 * This class implements the singleton design pattern and has therefore only a private constructor.
 **/
LinkManager::LinkManager()
{
59 60
    links = QList<LinkInterface*>();
    protocolLinks = QMap<ProtocolInterface*, LinkInterface*>();
pixhawk's avatar
pixhawk committed
61 62 63 64 65
}

LinkManager::~LinkManager()
{
    disconnectAll();
Lorenz Meier's avatar
Lorenz Meier committed
66 67 68 69
    foreach (LinkInterface* link, links)
    {
        if(link) link->deleteLater();
    }
pixhawk's avatar
pixhawk committed
70 71 72 73
}

void LinkManager::add(LinkInterface* link)
{
Lorenz Meier's avatar
Lorenz Meier committed
74 75
    if (!links.contains(link))
    {
76
        if(!link) return;
77
        connect(link, SIGNAL(destroyed(QObject*)), this, SLOT(removeObj(QObject*)));
78 79 80
        links.append(link);
        emit newLink(link);
    }
pixhawk's avatar
pixhawk committed
81 82 83 84 85 86
}

void LinkManager::addProtocol(LinkInterface* link, ProtocolInterface* protocol)
{
    // Connect link to protocol
    // the protocol will receive new bytes from the link
87
    if(!link || !protocol) return;
88 89 90 91 92

    QList<LinkInterface*> linkList = protocolLinks.values(protocol);

    // If protocol has not been added before (list length == 0)
    // OR if link has not been added to protocol, add
Lorenz Meier's avatar
Lorenz Meier committed
93 94
    if ((linkList.length() > 0 && !linkList.contains(link)) || linkList.length() == 0)
    {
95 96
        // Protocol is new, add
        connect(link, SIGNAL(bytesReceived(LinkInterface*, QByteArray)), protocol, SLOT(receiveBytes(LinkInterface*, QByteArray)));
97 98
        // Add status
        connect(link, SIGNAL(connected(bool)), protocol, SLOT(linkStatusChanged(bool)));
99 100
        // Store the connection information in the protocol links map
        protocolLinks.insertMulti(protocol, link);
101 102
        // Make sure the protocol clears its metadata for this link.
        protocol->resetMetadataForLink(link);
103
    }
104
    //qDebug() << __FILE__ << __LINE__ << "ADDED LINK TO PROTOCOL" << link->getName() << protocol->getName() << "NEW SIZE OF LINK LIST:" << protocolLinks.size();
pixhawk's avatar
pixhawk committed
105 106 107 108 109 110 111
}

QList<LinkInterface*> LinkManager::getLinksForProtocol(ProtocolInterface* protocol)
{
    return protocolLinks.values(protocol);
}

112 113 114 115
ProtocolInterface* LinkManager::getProtocolForLink(LinkInterface* link)
{
    return protocolLinks.key(link);
}
pixhawk's avatar
pixhawk committed
116 117 118

bool LinkManager::connectAll()
{
119 120
    bool allConnected = true;

Lorenz Meier's avatar
Lorenz Meier committed
121 122
    foreach (LinkInterface* link, links)
    {
123 124 125 126 127
        if(!link) {}
        else if(!link->connect()) allConnected = false;
    }

    return allConnected;
pixhawk's avatar
pixhawk committed
128 129 130 131
}

bool LinkManager::disconnectAll()
{
132 133
    bool allDisconnected = true;

Lorenz Meier's avatar
Lorenz Meier committed
134 135
    foreach (LinkInterface* link, links)
    {
136 137 138 139 140 141
        //static int i=0;
        if(!link) {}
        else if(!link->disconnect()) allDisconnected = false;
    }

    return allDisconnected;
pixhawk's avatar
pixhawk committed
142 143 144 145
}

bool LinkManager::connectLink(LinkInterface* link)
{
146 147
    if(!link) return false;
    return link->connect();
pixhawk's avatar
pixhawk committed
148 149 150 151
}

bool LinkManager::disconnectLink(LinkInterface* link)
{
152 153
    if(!link) return false;
    return link->disconnect();
pixhawk's avatar
pixhawk committed
154 155
}

156
void LinkManager::removeObj(QObject* link)
157 158
{
    LinkInterface* linkInterface = dynamic_cast<LinkInterface*>(link);
Lorenz Meier's avatar
Lorenz Meier committed
159 160
    if (linkInterface)
    {
161
        removeLink(linkInterface);
162 163 164
    }
}

165 166
bool LinkManager::removeLink(LinkInterface* link)
{
Lorenz Meier's avatar
Lorenz Meier committed
167 168 169 170 171 172
    if(link)
    {
        for (int i=0; i < QList<LinkInterface*>(links).size(); i++)
        {
            if(link==links.at(i))
            {
173
                links.removeAt(i); //remove from link list
174 175
            }
        }
176 177
        // Remove link from protocol map
        QList<ProtocolInterface* > protocols = protocolLinks.keys(link);
Lorenz Meier's avatar
Lorenz Meier committed
178 179
        foreach (ProtocolInterface* proto, protocols)
        {
180 181
            protocolLinks.remove(proto, link);
        }
182 183 184 185

        // Emit removal of link
        emit linkRemoved(link);

186 187 188
        return true;
    }
    return false;
189 190
}

pixhawk's avatar
pixhawk committed
191 192 193 194 195 196 197 198
/**
 * The access time is linear in the number of links.
 *
 * @param id link identifier to search for
 * @return A pointer to the link or NULL if not found
 */
LinkInterface* LinkManager::getLinkForId(int id)
{
Lorenz Meier's avatar
Lorenz Meier committed
199 200
    foreach (LinkInterface* link, links)
    {
pixhawk's avatar
pixhawk committed
201 202 203 204 205 206 207 208 209 210 211 212
        if (link->getId() == id) return link;
    }
    return NULL;
}

/**
 *
 */
const QList<LinkInterface*> LinkManager::getLinks()
{
    return QList<LinkInterface*>(links);
}