PX4飞控-自定义发送MavLink消息

一、自定义XML文件

如图所示。

这相当于定义了一个结构体，结构体里面就有一个类型为uint8_t的u8元素。

使用的id端口为150，这里注意不要与已经存在的id重复。

二、使用XML文件生成对应的头文件

在这里需要使用到一个工具mavlink_generator，它的安装方法比较简单。

在命令行依次输入下方命令即可完成安装：

git clone https://github.com/mavlink/mavlink.git

cd mavlink
    
git submodule update --init --recursive
    
python -m mavgenerate

之后会弹出下图界面：

点击第一个Browse，选择之前新建的XML文件。

点击第二个Browse，选择最终的输出文件夹。

将Language切换为C，其他保持默认。

最终选择界面如下图所示

点击Generate按钮，会弹出一个窗口，点击OK即可。

最后成功生成最终文件。

三、将生成的头文件添加到源代码中

在生成目录找到mavlink_msg_mytestmessage.h（这个文件名不是固定的，根据个人定义而不同。）

将这个文件复制到源代码/mavlink/include/mavlink/v2.0/common目录下。

同时在同目录的common.h文件中添加刚才复制的头文件。

四、修改mavlink_messages.cpp文件

class MavlinkMytestMessage : public MavlinkStream
{
public:
	const char *get_name() const override
	{
		return MavlinkMytestMessage::get_name_static();
	}

	static constexpr const char *get_name_static()
	{
		return "MytestMessage";
	}

	static constexpr uint16_t get_id_static()
	{
		return MAVLINK_MSG_ID_TEST_TYPES;
	}

	uint16_t get_id() override
	{
		return get_id_static();
	}

	bool const_rate() override
	{
		return true;
	}

	static MavlinkStream *new_instance(Mavlink *mavlink)
	{
		return new MavlinkMytestMessage(mavlink);
	}

	unsigned get_size() override
	{
		return MAVLINK_MSG_ID_TEST_TYPES_LEN + MAVLINK_NUM_NON_PAYLOAD_BYTES;
	}

private:
	/* do not allow top copying this class */
	MavlinkMytestMessage(MavlinkMytestMessage &) ;
	MavlinkMytestMessage &operator = (const MavlinkMytestMessage &) ;

protected:
	explicit MavlinkMytestMessage(Mavlink *mavlink) : MavlinkStream(mavlink)
	{}
	~MavlinkMytestMessage()
	{}
    /* 发送函数 */
	bool send(const hrt_abstime t) override
	{
        /* 创建结构体 */
		mavlink_test_types_t test;
        /* 结构体变量赋值 */
		test.u8 = 150;
        /* 发送函数 */
		mavlink_msg_test_types_send_struct(_mavlink->get_channel(), &test);
		return true;
	}
};