mavros.h

Go to the documentation of this file.

/*
 * Copyright 2014,2015 Vladimir Ermakov.
 *
 * This file is part of the mavros package and subject to the license terms
 * in the top-level LICENSE file of the mavros repository.
 * https://github.com/mavlink/mavros/tree/master/LICENSE.md
 */

#pragma once

#include <array>
#include <ros/ros.h>
#include <pluginlib/class_loader.hpp>
#include <mavconn/interface.h>
#include <mavros/mavros_plugin.h>
#include <mavros/mavlink_diag.h>
#include <mavros/utils.h>

namespace mavros {
class MavRos
{
public:
        MavRos();
        ~MavRos() {};

        void spin();

private:
        ros::NodeHandle mavlink_nh;
        // fcu_link stored in mav_uas
        mavconn::MAVConnInterface::Ptr gcs_link;
        bool gcs_quiet_mode;
        ros::Time last_message_received_from_gcs;
        ros::Duration conn_timeout;

        ros::Publisher mavlink_pub;
        ros::Subscriber mavlink_sub;

        diagnostic_updater::Updater gcs_diag_updater;
        MavlinkDiag fcu_link_diag;
        MavlinkDiag gcs_link_diag;

        pluginlib::ClassLoader<plugin::PluginBase> plugin_loader;
        std::vector<plugin::PluginBase::Ptr> loaded_plugins;

        std::unordered_map<mavlink::msgid_t, plugin::PluginBase::Subscriptions> plugin_subscriptions;

        UAS mav_uas;

        void mavlink_pub_cb(const mavlink::mavlink_message_t *mmsg, const mavconn::Framing framing);
        void mavlink_sub_cb(const mavros_msgs::Mavlink::ConstPtr &rmsg);

        void plugin_route_cb(const mavlink::mavlink_message_t *mmsg, const mavconn::Framing framing);

        void add_plugin(std::string &pl_name, ros::V_string &blacklist, ros::V_string &whitelist);

        void startup_px4_usb_quirk();
        void log_connect_change(bool connected);
};
}       // namespace mavros