PX4自动任务飞行AUTO_MISSION的实现流程

第一步,进入方式。

    与之前分析的POSCTL模式类似,主要有遥控器开关和指令两种模式,实现过程完全相同。

    最终都是调用了main_state_transition()函数将新模式写入到internal_state.main_state中。

第二步,导航模式和控制模式的选择。

    在commander的主循环中,set_nav_state()来设定导航模式。由于自动任务飞行需要使用各种传感器来提供信息,如果一切正常则设置导航模式为status->nav_state = vehicle_status_s::NAVIGATION_STATE_AUTO_MISSION; 如果,有任何的传感器状态异常,则切换到其他的导航模式中。由于set_nav_state()函数是在主循环中不断运行的,传感器状态也在不断更新,也就是说正常进行自主任务飞行的过程中一旦发生了传感器异常就会立即切换到应急处置的对应导航模式中。

    在set_control_mode()函数中根据nva_state的值设定了控制相关的flag,与位置控制类似。

    按照一定周期发布了vehicle_control_mode和vehicle_status两个消息。

第三步,导航过程的实现。

    在上一篇POSCTL的分析中提到,在进入了navigator后根据导航模式_vstatus.nav_state选择对应的导航模式实例。对POSCTL而言_navigation_mode = nullptr,因此没有进行任何具体的操作;而对AUTO_MISSION而言_navigation_mode = &_mission,是一个类型为Mission的实例。Mission这个类继承自MissionBlock类,后者又继承了NavigatorMode类。

  • 6
    点赞
  • 33
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值