Pixhawk之获取传感器数据并更新姿态

最新推荐文章于 2023-06-20 20:53:36 发布

llq_ARM

最新推荐文章于 2023-06-20 20:53:36 发布

阅读量6.2k

点赞数

文章标签： pixhawk 姿态传感器 ardupilot AHRS

本文链接：https://blog.csdn.net/llq_ARM/article/details/51384302

版权

本文深入解析Pixhawk如何通过AP_InertialSensor_PX4获取传感器数据，包括加速度和陀螺仪，并详细介绍了更新姿态的流程，涉及到的函数如_update_DCM(), _get_sample()等，以及底层驱动的read函数交互。" 127456027,7991216,UG二次开发：GRIP实现零件属性添加,"['三维建模', '软件开发', 'UG NX', '数据管理']

摘要由CSDN通过智能技术生成

博主：UAV

声明：尊重版权，转载请注明出处。

原文地址：

联系方式：595493514 @qq.com

技术交流QQ：595493514

read_AHRS();是负责更新姿态函数，更新姿态要获取传感器数据进行姿态解算，我们先来分析下传感器是怎么读取的。read_AHRS();调用的是ahrs.update()；ahrs是类AP_AHRS_NavEKF的一个实例， ahrs.update()调用了下面三个函数，update_DCM(); update_EKF1(); update_EKF2()；我们先分析update_DCM(); 调用了AP_AHRS_DCM::update()，继续调用_ins.update()；_ins.update()就是更新加速度和陀螺仪的数据，因为class AP_AHRS_DCM : public AP_AHRS，所以 AP_AHRS_DCM是AP_AHRS的一个子类。在AP_ARHS.h的文件中找到_ins 的定义：AP_InertialSensor &_ins；找到函数void AP_InertialSensor::update(void)中更新数据的函数是_backen