Ardupilot自定义mavlink消息

小laji

已于 2022-08-16 10:08:30 修改

阅读量802

点赞数 3

分类专栏： ArduPilot 文章标签：学习 c++

于 2022-07-28 10:53:57 首次发布

本文链接：https://blog.csdn.net/PENG__WANG/article/details/123696033

版权

ArduPilot 专栏收录该内容

2 篇文章 2 订阅

订阅专栏

在ardupilot\modules\mavlink\message_definitions\v1.0\commom.xml文件结尾处添加自定义消息

<!-- 20220713WP:添加一个mavlink消息 -->
    <message id="255" name="MAV_MESSAGE_TEMP_TEST">
      <description>send test message to gcs</description>
      <field type="int16_t" name="message1">message1</field>
      <field type="int16_t" name="message2">message2</field>
      <field type="int16_t" name="message3">message3</field>
      <field type="int16_t" name="message4">message4</field>
    </message>

然后基于构型编译(./waf plane)，生成头文件mavlink_msg_mav_message_temp_test.h，位置为

E:\GitHub\ardupilot4.1.1\build\fmuv3\libraries\GCS_MAVLink\include\mavlink\v2.0\common

在ardupilot/libraries/GCS_MAVLink/GCS.h中的GCS_MAVLINK类下声明函数

send_mav_message_temp_test()

    // common send functions
    // 声明自定义的mavlink信息发送函数
    void send_mav_message_temp_test(void);
    void send_heartbeat(void) const;
    void send_meminfo(void);
    void send_fence_status() const;

在GCS_Common.cpp中实现

// 发送自定义信息数据
void GCS_MAVLINK::send_mav_message_temp_test(void)
{
    //该函数自动生成，包含四个变量    
    mavlink_msg_mav_message_temp_test_send(chan, 0x0a,0x0b,0x0c,0x0d);
}

添加相对应的ap_message msg_id

ap_message GCS_MAVLINK::mavlink_id_to_ap_message_id(const uint32_t mavlink_id) const
{
    static const struct {
        uint32_t mavlink_id;
        ap_message msg_id;
    } map[] {
        ...
        { MAVLINK_MSG_ID_MAV_MESSAGE_TEMP_TEST, MSG_MAV_MESSAGE_TEMP_TEST},//自定义的mavlink
        ...
            };
}

在libraries/GCS_MAVLink/ap_message.h结尾添加

enum ap_message : uint8_t {
    ...
    MSG_MAV_MESSAGE_TEMP_TEST,// 自定义的mavlink消息
    ...
};

在ardupilot/arduplane/GCS_Mavlink.cpp中的try_send_message函数的添加case调用

bool GCS_MAVLINK_Plane::try_send_message(enum ap_message id)
{
    switch (id) {
    ...  
    case MSG_MAV_MESSAGE_TEMP_TEST:
        CHECK_PAYLOAD_SIZE(MAV_MESSAGE_TEMP_TEST);
        send_mav_message_temp_test();// 调用自定义的信息发送函数send_mav_message_temp_test
        gcs().send_text(MAV_SEVERITY_DEBUG, "hahahahaha !!!");
        break;
    ...
}

并在ap_message STREAM_EXTRA1_msgs[]数组中加入MSG_MAV_MESSAGE_TEMP_TEST，否则无法发送到地面站

static const ap_message STREAM_EXTRA1_msgs[] = {
    MSG_ATTITUDE,
    MSG_SIMSTATE,
    MSG_AHRS2,
    MSG_RPM,
    MSG_AOA_SSA,
    MSG_PID_TUNING,
    MSG_LANDING,
    MSG_ESC_TELEMETRY,
    MSG_EFI_STATUS,
    MSG_MAV_MESSAGE_TEMP_TEST,// 这里至关重要，否则无法正常发送到地面站，但是没搞懂为什么
};

编译，烧录固件到飞控，连接地面站（否则一直发应答包，不会发数据包，检测不到），断开，然后打开串口助手获取16进制数据，在输出的mavlink消息中寻找定义的0x0a,0x0b,0x0c,0x0d数据。