X5之position_estimator_inav_main.c


启动:rcs文件:sh /etc/init.d/rc.mc_apps   在rc.mc_apps 

#!nsh
#
# Standard apps for multirotors:
# att & pos estimator, att & pos control.
#

# The system is defaulting to INAV_ENABLED = 1
# but users can alternatively try the EKF-based
# filter by setting INAV_ENABLED = 0
if param compare INAV_ENABLED 1
then
    # The system is defaulting to EKF_ATT_ENABLED = 1
    # and uses the older EKF filter. However users can
    # enable the new quaternion based complimentary
    # filter by setting EKF_ATT_ENABLED = 0.
    if param compare EKF_ATT_ENABLED 1
    then
        attitude_estimator_ekf start
    else
        attitude_estimator_q start
    fi
    #position_estimator_inav start
    #pos_nav_kf start    #huangtao
    pos_inav_sonar start    #huangtao
else
    ekf_att_pos_estimator start
fi

if mc_att_control start
then
    echo "mc_att_control start ok"
else
    echo "mc_att_control start fail"
fi

if mc_pos_control start
then
    echo "mc_pos_control start ok"
else
    echo "mc_pos_control start fail"
fi


# Start Land Detector
land_detector start multicopter


评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值