ArduPilotMegaMAV.cc 2.15 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11
/*=====================================================================
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.
12
    
13 14 15 16
    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.
17
    
18 19
    You should have received a copy of the GNU General Public License
    along with QGROUNDCONTROL. If not, see <http://www.gnu.org/licenses/>.
20
    
21 22 23 24 25 26 27 28
======================================================================*/

/**
 * @file
 *   @brief Implementation of class MainWindow
 *   @author Your Name here
 */

29
#include "ArduPilotMegaMAV.h"
30

31
ArduPilotMegaMAV::ArduPilotMegaMAV(MAVLinkProtocol* mavlink, int id) :
32 33 34 35
        UAS(mavlink, id)//,
        // place other initializers here
{
}
36 37 38 39 40 41 42 43 44

/**
 * This function is called by MAVLink once a complete, uncorrupted (CRC check valid)
 * mavlink packet is received.
 *
 * @param link Hardware link the message came from (e.g. /dev/ttyUSB0 or UDP port).
 *             messages can be sent back to the system via this link
 * @param message MAVLink message, as received from the MAVLink protocol stack
 */
45
void ArduPilotMegaMAV::receiveMessage(LinkInterface* link, mavlink_message_t message)
46 47 48
{
    // Let UAS handle the default message set
    UAS::receiveMessage(link, message);
49 50
    
    if (message.sysid == uasId)
51
    {
52 53
        // Handle your special messages
        switch (message.msgid)
54
        {
55 56 57 58 59 60 61
        case MAVLINK_MSG_ID_HEARTBEAT:
            {
                qDebug() << "ARDUPILOT RECEIVED HEARTBEAT";
                break;
            }
        default:
            qDebug() << "\nARDUPILOT RECEIVED MESSAGE WITH ID" << message.msgid;
62 63 64 65
            break;
        }
    }
}