手搓STM32H743开源飞控系列教程---(五) 飞控IMU方向调整
1. 为什么需要调整飞控IMU方向第一次玩飞控的朋友可能会遇到一个奇怪现象明明把飞控板水平放在桌面上地面站显示的姿态却歪了30度。这种情况十有八九是IMU安装方向与飞控默认设定不匹配导致的。我刚开始玩穿越机时就踩过这个坑当时把飞控倒装在机架上结果解锁瞬间飞机直接翻跟头炸机。IMU惯性测量单元是飞控的核心传感器包含加速度计和陀螺仪。它就像飞控的内耳需要准确感知飞行器的俯仰、横滚和偏航。但IMU芯片在电路板上的安装方向是固定的当飞控板因装机需要旋转或倒置时必须通过软件配置告诉飞控现在传感器实际朝向变了。举个例子物唯飞控默认定义焊盘面朝上为顶面。但实际装机时你可能需要把飞控倒置安装芯片面朝上旋转90度避开USB接口干扰侧装以适应狭长机架这些物理安装变化都会导致IMU的XYZ轴与实际飞行坐标系错位。如果不做方向校准飞控会误判姿态轻则漂移不稳重则直接失控。去年帮朋友调试一架竞速穿越机就因为他把飞控旋转了180度但没改IMU参数导致飞机一推油门就倒飞撞墙。2. 理解飞控的坐标系定义在调整方向参数前必须搞清楚三个坐标系的关系。这就像玩拼图前得先看清图纸2.1 飞控本体坐标系以物唯WFG100飞控为例其他飞控逻辑类似顶面能看到焊盘和LED灯的那面官方默认朝上机头方向板载三角形箭头指向通常靠近USB接口侧右手坐标系定义X轴指向机头前进方向Y轴指向右侧Z轴垂直顶面向下2.2 IMU芯片坐标系MPU6050/MPU9250等常见IMU芯片都有自己的坐标系芯片表面通常有个小圆点标记X轴方向数据手册会明确XYZ轴定义飞控厂商已做好芯片到飞控坐标系的初始映射2.3 世界坐标系地面站显示的三维姿态基于东北天坐标系NED地磁北极为参考基准当你在Mission Planner里看到飞机图标倾斜就是飞控将本体坐标系转换到世界坐标系的结果。如果转换关系错了显示自然就不准。3. APM固件的IMU方向调整实战APM/PX4固件通过AHRS_ORIENTATION参数管理IMU方向。这个参数本质是一个旋转矩阵索引值对应着24种标准旋转方式0-23。物唯飞控默认值是0表示无旋转。3.1 常见装机场景配置假设你需要将飞控芯片面朝上安装即翻转180度连接Mission Planner地面站进入配置/调试→全部参数表找到AHRS_ORIENTATION参数将值从0改为8绕X轴旋转180度点击写入参数重启飞控使配置生效重要提示修改后一定要做传感器校准具体步骤1. 将飞控水平放置 2. 点击校准加速度计 3. 按提示完成六面校准 4. 校准完成后晃动飞控观察地面站姿态显示是否与实际一致3.2 验证方向是否正确最直接的测试方法将飞机平放在水平桌面在地面站查看俯仰/横滚角应为0°±1°考虑桌面不平将机头抬起约45度地面站应显示俯仰角45°向右倾斜机身应显示负横滚角APM坐标系定义如果显示角度与物理动作相反或错乱说明旋转矩阵选错了。这时需要查阅方向参数对照表尝试相邻编号的值如7或9重复测试直到匹配4. Betaflight固件的方向配置BF固件的配置更直观适合新手快速上手。关键参数是board alignment4.1 基础设置步骤打开Betaflight Configurator进入Configuration标签页找到Board and Sensor Alignment区域修改以下参数roll degrees绕X轴旋转正值为右倾pitch degrees绕Y轴旋转正值为抬头yaw degrees绕Z轴旋转正值为顺时针例如飞控倒装时需要设置roll 0 pitch 180 yaw 04.2 高级技巧自定义旋转矩阵对于非标准安装如斜置飞控可以使用更灵活的custom board alignment启用Custom Board Alignment填写3x3旋转矩阵# 示例绕Z轴旋转90度 [[ 0, 1, 0], [-1, 0, 0], [ 0, 0, 1]]点击Save and Reboot实测发现BF 4.3版本对非正交旋转的支持更好。之前调试一架异形机架需要将飞控倾斜30度安装用自定义矩阵完美解决了问题。5. 源码级永久修改方案如果你在批量生产或需要固化配置可以直接修改飞控源码5.1 APM固件修改位置在ArduCopter的hwdef.dat文件中添加# 物唯飞控默认方向 define IMU_ORIENTATION_ROTATION_DEFAULT 0 # 改为倒装时的配置 define IMU_ORIENTATION_ROTATION_DEFAULT 85.2 Betaflight修改位置在target.c文件中调整// 默认方向 static const sensorAlignment_t sensorAlignment { .align_gyro CW0_DEG, .align_acc CW0_DEG }; // 改为旋转180度 static const sensorAlignment_t sensorAlignment { .align_gyro CW180_DEG, .align_acc CW180_DEG };修改后需要重新编译固件。建议先通过地面站调试确认正确参数值再固化到代码中。去年给学校无人机社团培训时我们就用这个方法统一了20套飞控的安装标准。
本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.coloradmin.cn/o/2456351.html
如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈,一经查实,立即删除!