1.在px4项目下的src文件夹下的modules文件夹中创建一个文件夹,如图我创建了一个position_control文件夹,在该文件夹中添加自己写的代码程序,同时添加一个CmakeLists.txt文本,然后在.txt文本中的SRCS行下加入自己写的代码文本名称fxdd.cpp
2.完成上诉步骤后返回px4项目,打开boards文件夹下的px4文件,再打开fmu-v5文件,找到debug.cmake和default.cmake这两个文本,分别打开并在MODULES行下加上自己之前创建的代码文件名称position_control,保存后进行编译make px4_fmu-v5_default 直到编译通过。
进一步详细讲解以及如何添加msg消息可参考下述文章: