多旋翼无人机二次开发 知识准备2：系统配套飞控 多旋翼无人机二次开发(现代职业)1_知识准备2系统配套飞控详细介绍.docx

第二章 系统配套飞控详细介绍 2.1硬件介绍 2.1.1嵌入式软件介绍 常见的嵌入式软件有Nuttx ，它是一种实时的嵌入式操作系统（RTOS），可以使用在微控制器的环境中。在Nuttx嵌入式系统中，较为常用的是卡尔曼滤波。卡尔曼滤波典型的应用，简单的讲，就是从一组有限的包含噪声的信号序列中预测出被测物体的位置坐标及其速度。跟踪目标时，测量所得目标的位置、速度、加速度的信号往往包含有噪声，卡尔曼滤波则可以去除噪声的影响，得到一个较好的目标位置的估计值。 捷联惯导是利用惯性传感器（陀螺仪、角加速度传感器及线加速度传感器）及其基准位置和初始位置信息来计算获得飞行器的位置、速度及加速度的信息的导航方法。 捷联惯导算法的基本过程为： ● 初始化系统：给定飞行器的初始位置和初速度；校准数学平台；仪表校 准。 ● 误差补偿 ● 姿态矩阵计算。 ● 导航计算 ● 输出导航信息 图4.1 捷联惯导算法基本过程 惯性元件有固定的漂移率，这会给导航造成误差，因此捷联惯导系统还须采用指令、GPS或其组合等方式定时进行修正，以获取持续准确的位置参数。 2.1.2安装与调试 安装：飞控应该在多旋翼平面的几何中心，并固定在减震器上；连线：见下图。 图4.2 飞控接口 图4.3 飞控接线标注 ● 在安装完飞控之后（安装前也可以），我们就需要开始使用地面站软件，也就是Mission Planner（下面使用缩写：MP）来对飞控上的很多传感器进行调试和校准。下面我们将详细介绍MP软件的使用。 ● 将飞控和电脑用数据线连接。在烧录固件完成之前不要点击右上角的连接按钮。 图4.4 MP软件界面 ● 固件升级：最开始的工作就是往飞控内烧录多旋翼飞行器固件，也就是固件升级。在MP的主界面的左上角有一排按钮，我们仅仅使用前四个按钮。 ● 点击初始设置，将看到很多图标。 图4.5 烧写固件 ● 选择第三个图标（多旋翼飞行器） 图4.6 确认刷新固件 ● 点击Yes开始上传固件。 图4.7 烧写固件中 ● 固件烧录完成！ 我们第一次使用配套飞控时，也可以通过向导来烧录固件。点击向导。注意，此时飞控出于断开状态。 图4.8 烧写完成 ● 选择第三个Multirotor，单击下一步。 图4.9 根据向导设置 ● 选择多旋翼飞行器，单击下一步。 图4.10 根据向导设置 ● 在下拉菜单中选择飞控在电脑中对应的COM口，单击下一步。 图4.11 根据向导设置 ● 此时电脑开始向飞控中烧录固件。 传感器校准：我们会利用MP中的传感器校准向导来完成飞控上的传感器校准。 图4.12 设置机架类型 ● 点击左上角的多旋翼飞行器标志。下一步。 图4.13 校准加速度计传感器 ● 这是加速度计校准界面。单击Start开始校准。按照指示一步一步做。直到调试完成，单击下一步。 图4.14校准加速度计传感器 图4.15 校准加速度计传感器 图4.16校准加速度计传感器 图4.17 校准加速度计传感器 图4.18 校准加速度计传感器 图4.19 校准加速度计传感器 完成加速度计调试之后，单击下一步。我们将开始罗盘校准。 图4.20 准备校准罗盘 ● 单击Live Calibration 开始校准。我们将会看到屏幕上弹出一个窗口。 图4.21 校准罗盘 ● 此时，我们将绕着飞控的XYZ三个轴充分旋转。直到坐标轴周围被点包围住为止，点击Done。单击下一步，并跳过电源显示器设置，直到遥控器通道校准界面。 图4.22 准备校准遥控 ● 单击continue，开始校准遥控器各个通道。 图4.23 校准遥控 ● 此时晃动遥控器上各个摇杆使其达到其上下左右端点以及每一个挡位。然后单击下一步，开始选择飞行模式。如下表调整选项，单击保存模式，并跳过剩下的所有步骤完成向导设置。 图4.24设置飞行模式 2.2、设置飞行模式和试飞 这里我们选择三种模式：增稳模式，定高模式，自降模式。 2.2.1、Stabilize mode增稳模式： 增稳模式是飞控的基本模式，不控的时候飞机的航向俯仰和横测由飞机保持稳定，操纵的时候直接对飞行器姿态进行操作。油门直接由操控手操作。需要注意的是，此模式是飞控姿态控制功能的基本能体现，在进行所有其他模式之前，应该首先对此模式进行调试和试飞。起飞时，由于气流的的涡旋地效，飞行器离地瞬间会有姿态乱的时候，需要小心。 2.2.2、Altitude Hode定高模式 当切换到此模式的时候，飞行器自动保持当前飞行高度，俯仰、横滚和航向则由遥控器控制。这个模式是很多其他飞行模式的组成部分，非常重要。需要注意的是，飞空使用气压传感器来控制高度，如果因为天气变化导致起亚传感器输出发生变化，飞行器的高度也会随之改变。如果飞行器安装并启动的超声波传感器，当飞行高度降低到79米左右时则使用该传感器进行高度控制