Microduino 四轴飞行器教程

Language	English

概述 项目名称：Microduino四轴飞行器 目的：通过Microduino Joypad来控制四轴飞行器。 难度：高级 耗时：6小时 制作者：Microduino Studio-PKJ&Microduino Studio-Joseph Leung 材料清单 Microduino设备 模块 数量 功能 Microduino-CoreRF 2 核心板 Microduino-USBTTL 1 下载程序 Microduino-10DOF 1 姿态稳定 Microduino-Joypad 1 遥控 Microduino-TFT 1 显示 Microduino-QuadCopter 1 四轴电机驱动 其他设备 USB数据线 1 下载程序 四轴飞行器机架 1 搭建四轴 电池 2 供电 文档 下载四轴控制程序： https://github.com/Microduino/Microduino_Tutorials/tree/master/Microduino_Advanced_Tutorial/Microduino_Joypad_QuadCopter/MultiWii 下载MultiWiiConf上位机软件： https://github.com/Microduino/Microduino_Tutorials/tree/master/Microduino_Advanced_Tutorial/Microduino_Joypad_QuadCopter/MultiWiiConf 下载PID配置文件： https://github.com/Microduino/Microduino_Tutorials/tree/master/Microduino_Advanced_Tutorial/Microduino_Joypad_QuadCopter/%E9%85%8D%E7%BD%AE%E6%96%87%E4%BB%B6 简介 原理 四旋翼飞行器通过调节4个螺旋桨的转速，改变推力，从而控制飞行器的姿态和位置。如图 1.2所示，在3个坐标轴上实现旋转，可以完成3个动作，即偏航（Yaw）、俯仰（Pitch）和滚转（Roll）；如果在三轴上实现平移的话，可完成垂直、前后和侧向运动。 Example.jpg Caption1 Example.jpg Caption2 图 1.2 四旋翼飞行器的基本动作 垂直运动 即飞行器垂直上升或下降。正如前文所说的，四个电机保持在同一转速，就能够在水平方向上保持稳定。如图1.3所示，如果四个电机增加到在同一个转速，产生的推力足以克服飞行器自身的重力，便能够上升；反之，如果四个电机同时降低到同一个速度，产生的推力无法克服飞行器的重力，便可以下降。如果外界没有其他的扰动，四个电机产生的推力恰好克服飞行器的重力，这样，飞行器就可以悬停在空中。 只要让四个电机保持在相同转速，便能够让飞行器平稳地垂直运动，相对来说比较简单。 图 1.3 垂直运动 前后运动和侧向运动 如图 1.4所示，电机1为飞行器头部，而电机2为飞行器尾部。 为了在水平上获得一个推力，增加电机2的转速，尾部的推力增加；降低电机1的转速，头部的推力减小；整个机身会向前倾，合成了一个水平向前的推力，机身便能够向前运动。同时保持电机3和4的转速，反扭矩平衡，才能够保证机身平稳地向前。向后运动正好与向前运动相反。 因为四旋翼飞行器是中心对称的，前后运动和侧向运动的控制是完全类似的，两组正反电机的控制方式对调即可。例如，保持电机1和2的转速不变，增加电机4的转速而降低电机3的转速，便能够产生向左的水平力，于是机身向左运动。 图 1.4 前后运动和侧向运动 偏航运动 前面介绍的三种运动都是空间三个轴上的平移，接下来要介绍的三种运动是绕着三轴的旋转。 偏航运动就是在水平方向上的左右转动，即绕着Z轴的旋转。旋翼在转动的过程中，由于空气阻力的作用，会形成与转动方向相反的反扭矩。偏航运动就是利用反扭矩实现的。当飞行器悬停时，4个电机的转速相同，两组正反扭矩相互抵消，维持平衡。当四个电机转速不完全相同时，不平衡的反扭力会引起四旋翼飞行器水平转动，从而实现偏航运动。如图 1.5所示，提升电机1和2的转速，同时降低电机3和4的转速，1和2 电机产生的顺时针反扭矩大于3和4电机产生的逆时针反扭矩，而且总的向上推力没有发生变化，于是机身在水平面上顺时针转动，又不会出现垂直位移。逆时针转动正好相反。 图 1.5 偏航运动 俯仰运动和滚转运动 俯仰运动是指在Y轴上的旋转，而滚转运动则是在X轴上旋转。 如图 1.6所示，提升电机1的转速，降低电机2的转速，两者转速的变化量应该一样，同时保持电机3和4转速不变。机身头部的推力大于尾部的推力，不平衡的力矩使得机身仰起。同样的，俯身运动则是降低电机1的转速，而提升电机2的转速，产生一个向前倾的力矩。 同样是因为中心对称的缘故，滚转运动与俯仰运动的原理一样。维持电机1和2的转速不变，改变电机3和4的转速，产生不平衡的力矩，使得机身绕着X轴做出滚转的运动。 图 1.6 俯仰运动和滚转运动 结构 四轴的组成示意图如图下图所示，简化后（只关心信号）的系统由遥控信号接收装置(此处为航模遥控接收器或者蓝牙模块)、飞行控制器以及四个电机组成。遥控信号接收装置接收控制端的信号之后转换为PWM或者PPM等信号传送给飞行控制器，飞行控制器根据遥控信号以及传感器的值来通过PWM控制四个电机以达到预期的动作。在飞行控制器中，陀螺仪以及加速度计是必须的，四轴的姿态是由这俩个传感器得到的数据来解算的，解算之后通过PID等算法来控制电机的转速。当然也可以加入电子罗盘以确定机头位置，加入GPS以确定四轴的地理位置。所以简单来讲四轴是一个有两个环的闭环控制系统，大环由遥控接收设备注入输入量，小环由姿态传感器注入输入量。 文件:Microduino QuadCopter Introduction2.jpg 600px 对于一般的固定翼航模来讲，飞控（飞行控制器）可有可无，一般玩家不会在固定翼航模上安装飞控，但是四轴不一样，四轴飞行器是一种具有三组自由度，四个控制输入的欠驱动系统。它需要一个控制系统来进行控制。 当然，这个过程中也有一些技术细节需要设计，比如传感器读入的数据需要进行滤波、俯仰（Pitch）、侧俯仰（Roll）、偏航（Yaw）等动作的PID算法设计及调整。这是一个较复杂的综合系统，如果玩家想在理论方面从零开始学习则需要介绍许许多多，受篇幅所限，请参考相关资料，这里就不详细介绍了。 优点 Microduino 采用独有的 U 型 27 Pin 接口规范（UPin-27），尺寸小巧，长25.4mm X 宽27.94mm，如一枚1元硬币的大1小。所有模块都可以通过 UPIN-27 堆叠在一起，即插即用。 Microduino四轴飞行器最少只需要用到5种功能模块以及推荐的330轴距机架组件就能实现其功能，分别为为：Microduino-Core、Microduino-10DOF、Microduino-BT、Microduino-QuadCopter、Microduino-Joypad。而且你只需要将模块叠堆起来就可以用，非常简单。 四轴飞行器机架搭建与调试 硬件组装 模块 数量 功能 Microduino-CoreRF 1 核心板 Microduino-USBTTL 1 下载程序 Microduino-10DOF 1 姿态稳定 Microduino-QuadCopter 1 四轴驱动 将飞控底板用四颗螺丝固定在机架底座上。安装时请自行设定一个向前的方向，飞控底板默认的前向是Upin口的开口方向。 文件:Microduino QuadCopter setup1.jpg 600px 将Microduino-QuadCopter用四颗螺丝固定在机架底座上。 文件:Microduino QuadCopter setup2.4.jpg 600px 将四个电机臂用螺丝安装在机架底座上，安装的时候玩家按照如下方法设定一个机头方向：一般的我们定义橙色的两个桨是前方的桨，黑色的两个桨是后方的桨，这样在飞远了以后仍然可以依靠桨的颜色来判别机头方向。安装时还要按照正确的顺序来，左前方和右下方的桨要安装A桨，右前方和左下方的桨要安装B桨。每个桨的上面都写有A、B来区分： 文件:Microduino QuadCopter setup2.1.jpg 600px 请玩家注意。安装方法如下图所示： 文件:Microduino QuadCopter setup2.2.jpg 600px 文件:Microduino QuadCopter setup2.3.jpg 600px 将四个电机用四颗螺丝固定在机架底座上。 文件:Microduino QuadCopter setup2.5.jpg 600px 在固定好四个机臂后将四个电机的导线接到飞控地板对应的焊盘上,其实底座和接口是匹配的，用户只需要插上去即可，但是最好还是确认下电机白色、红色的线接到底板标注有“+”的焊盘上，黑色、蓝色的线接到地板标注有“-”的焊盘上。如果接反，电机的转向就会反了，这样我们的小飞机就无法起飞。安装好的底板如下图所示。 文件:Microduino QuadCopter setup3.1.jpg 600px 文件:Microduino QuadCopter setup3.2.jpg 600px 这样就完成了机架的组装了。 两个蓝牙建立连接 我们是通过蓝牙建立无线遥控的，因此两个蓝牙连接就至关重要了。如何建立两个蓝牙连接，请参考：两个Microduino BT模块如何连接 下载与调试 先将Microduino-Core、Microduino-10DOF、Microduino-USBTTL叠堆到一起并安装到飞控底板上即可。如图3.4-1所示： 文件:Microduino QuadCopter Software1.jpg 600px 将四轴放在水平桌面上，用USB数据线连接到电脑，板卡选择Microduino Core (Atmega328P@16M,5V)，将修改好的程序进行编译，通过后下载到Microduino-Core中。 在MultiWiiConf\application.windows32里以管理员身份打开地面站软件MultiWiiConf.exe开始进行校准及参数调整。地面站软件的界面如下图。 文件:Microduino QuadCopter MultiWiiConf1.jpg 600px 电脑连接到四轴飞行器 点击RECONNECT进行连接，连接成功后通过Microduino-USBTTL串口进行数据通信。连接成功通过START按钮来获取传感器数据曲线，如图所示： 文件:Microduino QuadCopter MultiWiiConf2.jpg 600px 传感器校准 将四轴水平放置在桌面上，点击CALIB_ACC并在此后的大约五秒钟之内保持四轴平稳，飞控的加速度计会校准。待数据曲线稳定再点击CALIB_MAG并在此后的大约半分钟之内拿起飞机在各个轴向上反复绕动以校准电子罗盘，之后保持四轴平稳，待电子罗盘平衡后点击WRITE以将数值写入飞控。 通过点击SELLECT SETTING，我们可以进行参数设置，并且看到模拟的姿态，如图所示： 设置PID参数 PID三个标签下面对应的ROLL、PITCH、YAW值是我们要调整的。这些值通过合理的调整能使四轴非常平稳的飞行。改变这些值的方法是在其绿色的框内按下鼠标左键，向左移动鼠标数值就会减小，向右移动鼠标数值就会增大，达到想要的值以后松开鼠标左键。当然我们可以直接LOAD配置文件，点击LOAD，浏览到你下载你配置文件夹选择pkj.mwi导入，如图所示： 文件:Microduino QuadCopter MultiWiiConf PID.jpg 600px 设置飞行模式 在调整PID的右侧我们可以看到各种飞行模式以及对应辅助开关的一个二维表。一个开关或者多个开关的组合可以指定为一种飞行模式。我们建议玩家按照下图设置飞行模式，设置方法为在方块处点击鼠标左键，灰色的方块就会变成白色，这样就指定了在这样的开关方位时处于对应的飞行模式。ANGLE是增稳模式，这有助于我们飞行。设置好点击WRITE以将数值写入飞控。完成后关闭MultiWiiConf串口连接，将USB线从Microduino-USBTTL模块上拔下同时取下Microduino-USBTTL模块。四轴控制器就做好了。 文件:Microduino QuadCopter MultiWiiConf ANGLE.jpg 600px 遥控器（Microduino-Joypad）搭建与调试 遥控器我们采用Microduino-Joypad来实现，当然，你还需要其他模块，Microduino-TFT、Microduino-Core、Microduino-USBTTL、Microduino-BT（从机）。这样才能把遥控器搭建起来。 模块 数量 功能 Microduino-CoreRF 1 核心板 Microduino-USBTTL 1 下载程序 Microduino-Joypad 1 遥控 Microduino-TFT 1 显示屏 硬件搭建 步骤一：将Microduino-TFT安装在Microduino-Joypad面板上； 文件:Microduino Joypad TFT.jpg 600px 步骤二：将尼龙螺丝安装在Microduino-Joypad上，并且将底面板粘贴在Microduino-Joypad底部； 文件:Microduino Joypad nilong.jpg 600px 步骤三：将Microduino-TFT与Microduino-Joypad通过转接线连接起来； 文件:Microduino Joypad Connection.jpg 600px 步骤四：将锂电池连接到底板上，注意正负极别接反了，板子背面标注了正负极； 文件:Microduino Joypad power.jpg 600px 步骤五：将底板和面板用尼龙螺丝固定好； 文件:Microduino Joypad face bord.jpg 600px 步骤六：你可以打开电源开关，观察供电是否正常。 文件:Microduino Joypad switch.jpg 600px 步骤七：将Microduino-USBTTL、Microduino-Core叠加在Microduino-Joypad底座上。此时不需要叠加Microduino-BT模块，不然串口会冲突。 文件:Microduino Joypad Module.jpg 600px 软件调试 下载Microduino_Joypad_Ctrl程序： https://github.com/Microduino/Microduino_Tutorials/tree/master/Microduino_Joypad/Joypad_RC_2.3 同时你需要用到以下库： _01_Microduino_TFT_GFX：、_01_Microduino_TFT_ST7735 ：、_01_Microduino_TFT：、_08_Microduino_Shield_Joypad： 参考：安装Arduino IDE Microduino程序库支持包 打开Microduino_Joypad_Ctrl程序，编译成功通过后选择好板卡下载。 下载完毕后可取下Microduino-USBTTL模块，叠上Microduino-BT（主机）模块。最后进行整体调试。 文件:Microduino Joypad BT.jpg 600px 试飞 调试Microduino-Joypad 采用电池供电，拔出USB数据线，打开遥控器电源开关，按下复位按键（左边USB接口右边那个）进入系统，请在4S内按下【key1】按键（从左边数开始第一个），进入遥控器校准和控制选择模式。 文件:Microduino Joypad config1.jpg 600px 选择控制模式 我们可以通过【key3】按键来选择是控制四轴飞行器（Quad.）还是机器人（Robot），同时Robot模式可控制平衡车和BOXZ mini，黑色表示选中。因此我们需要选择到Quad.模式。 文件:Microduino Joypad config2-quad.jpg 600px 我们可以通过【key4】按键来选择是否是体感控制模式，当然选择体感模式，你必须叠加Microduino-10DOF/zh模块，选择“MPU ON”。如果是摇杆模式，选择“MPU OFF”。 文件:Microduino Joypad config3-quad.jpg 600px 摇杆校准 360度最大幅度旋转两个摇杆，看TFT屏上数据没变化即可按下【key2】按键，进入玩耍。 文件:Microduino Joypad config4-quad0.jpg 600px 文件:Microduino Joypad config4-quad.jpg 600px 将左上边控制开关打开（拨到上面），才能进行控制，你可以摇动摇杆，观察屏幕的变化。 文件:Microduino Joypad config5-quad.jpg 600px 右边开关是幅度调节模式，开关拨到上面可以最大幅度控制Robot，否则只能小幅度控制了，这样有助于稳定控制。 请把将左上边开关拨到下面（关闭油门），再把油门摇杆拨到最下方。 调试四轴机架 确定Microduino-QuadCopter上叠加Microduino-BT（从机）模块，用来和遥控器通讯。 把电池装到四轴机架底下，再和Microduino-QuadCopter电源线连接，注意正负，红线为正，黑线为负。 文件:Microduino QuadCopter Remote2.jpg 600px 打开Microduino-QuadCopter上的开关，放置在平稳的地方，按下复位按键，系统将对传感器进行校准，未完成时板子上红色led灯闪烁，校准完成后将熄灭，此时等待解锁。 文件:Microduino QuadCopter Remote3.jpg 600px 整体测试 观察Microduino-QuadCopter上的Microduino-BT（从机）模块是否和Microduino-Joypad上的Microduino-BT（主机）连接，蓝牙模块连接指示灯不再闪烁。 文件:Microduino QuadCopter Remote4.jpg 600px 对四轴进行解锁，将左上边开关拨到下面（关闭油门），防止解锁后不小心开了油门使四轴飞行器起飞发生意外。将油门滑竿置于最右下方，可看到机架底板上led灯开始闪烁，准备链接，等待2S左右，恢复油门滑竿，再置于最又下方，依次循环，直到led长亮说明解锁成功，这样就可以准备飞了。如果尝试多次不能解锁，对四轴飞行器核心复位，系统将对传感器进行校准，重新尝试解锁。 文件:Microduino QuadCopter Remote5.jpg 600px 再把油门摇杆拨到最下方，左上边开关往上推（打开油门开关），这时参考摇杆控制示意图，你只要轻轻推动油门即可看到四个螺旋浆开始飞速转起来了。继续加大油门，确保它飞起来了。可以稍微高一点，不要紧贴地面，然后通过方位摇杆控制平衡了。 当发现在猛推油门的情况下飞机也只会贴着地飞行而无法一飞冲天的时候就表明电池电量已耗尽，请给电池充电以避免事故发生。我们的飞控底板集成了充电管理，只需要将usb线缆的一头插在充电器上，另一头插到飞控底板上的microusb接口即可对电池充电。 文件:Microduino-Joypad-Pinout4Big.jpg 800px 当你想关掉飞行器，请一定要先断开四轴的电源，再断开遥控器电源，否者四轴将失控，避免发生意外。 注意问题 蓝牙连接是第一步，也是关键的一步，请确定两个蓝牙能够连接。 下载程序时候请不要叠加BT模块，这样会引起串口冲突，容易出现问题。 注意四轴飞行器四个螺旋桨的安装，别错了，否者飞不起来。 锂电池正负极别接错了，否则会烧坏电路。 飞行器请先对遥控器（Microduino-Joypad）进行校准，否者容易导致飞不稳。 遥控解锁前请先把左上边开关拨到下面（关闭油门），开始试飞请先把油门调到最低，避免解锁后油门值太大起飞发生意外。 当你想关掉飞行器，请一定要先断开四轴的电源，再断开遥控器电源，否者四轴将失控，避免发生意外。