两轴云台及击发控制的设计与实现

RoboMasters机器人大赛

两轴云台及击发控制的设计与实现

目录

一. 项目概述 (4)

1. 比赛简介 (4)

2. 课题简介 (4)

二. 项目目标 (5)

1. 基本功能与性能 (5)

2. 扩展功能与性能 (5)

三. 系统设计方案 (5)

1. 系统框图

(5)

2. 子系统框图 (6)

3. 方案比较 (7)

四. 各模块工作原理（详细设计部分） (13)

1. 串口通信协议设计 (13)

2. 弹药击发结构及驱动设计 (14)

3. 两轴云台运动控制 (14)

五. 系统测试及调试 (17)

1. 以云台控制视觉识别为例介绍测试流程 (17)

2. 其他的问题以及解决方案 (18)

六. 项目实施总结及心得体会 (20)

七. 致谢 (21)

八. 参考文献 (21)

九. 附录 (22)

1. 电路图 (22)

2. 源工程详见附件 (23)

一. 项目概述

1. 比赛简介

RoboMasters 是一项全新的机器人超级对抗赛。参赛队伍通过自行设计制造多种机器人进行射击对抗，完成指定任务，由比赛裁判系统判定比赛胜负。参赛机器人包括可以发射“弹丸”的手动机器人以及能够完成一定任务的自动机器人。参赛队员需要遥控手动机器人在复杂的场地中移动并发射“弹丸”，攻击对方机器人和基地以取得胜利。自动机器人将在比赛中自动完成指定任务。

每场比赛双方最多可各有6 台机器人上场参与对抗，每队的编制是2 台机器步兵、2 台机器射手、1 台机器炮手和1 台机器哨兵。2 台机器步兵由比赛组委会提供，其余机器人均由参赛队员自行设计制作完成。

比赛采用红、蓝双方对抗的形式，每场比赛采用多局制，每局限时5 分钟。

2. 课题简介

图：战车主要模块分布图

本项目基于STM32F405开发平台，主要利用位置式双闭环PID控制算法，实现对两轴云台的运动以及发弹的控制。

云台控制板通过串口分别与主控板及工控机进行通信，从底盘主控板或工控

机获取两轴云台运动指令及发射子弹指令，再经由电流环、位置环双闭环PID

控制算法，精确控制云台运动模式，并尽可能快、尽可能稳地使两轴云台达到目标位置；同时通过输出不同占空比PWM波，驱动并控制双摩擦轮转速，达到发射子弹的要求。

二. 项目目标

1. 基本功能与性能

（1）通信部分：云台控制部分能够通过串口与底盘主控和工控机正常通信，正常接收与传送数据或指令。

（2）云台运动：两轴云台可以按照指定指令，快速到达规定角度位置，并稳定下来。

（3）子弹发射：可以正常驱动双摩擦轮，并以固定速度发射子弹。

2. 扩展功能与性能

（1）串口通信在正常通信的情况下，要在满足系统对通信速率的要求下，设计相应具有查错或纠错能力的通信协议，使误码率尽可能低，提高通信的稳定性。（2）两轴云台在满足系统对稳定性的要求下，改进系统参数，要求尽可能提高对系统指令的响应速度。

（3）在实现以单一速度驱动双摩擦轮的基础上，实现根据底盘指令，变速控制双摩擦轮，多级调速，满足不同对战环境下的发射子弹速度要求。

三. 系统设计方案

1. 系统框图

图：系统框图

由图，云台控制部分处于整个通信系统的中心：一方面，云台控制中心需要通过串口与底盘主控进行通信，接收来自操作手通过遥控器转发过来的关于云台的相关指令；另一方面，云台控制中心需要通过串口与火控部分工控机进行直接通信，接收在自动瞄准过程中的云台自动调整功能，这一部分的设计由于环境等因素在区域赛中没有起到作用。

特别地，在炮手系统设计中，云台控制中心还要负责转发工控机关于底盘自适应性运动的相关指令，控制底盘运动，如下图：

图：炮手通信

2. 子系统框图

子系统主要涉及到摩擦轮驱动部分以及两轴云台驱动部分。具体框图如下：

HG900电调PWM 波

摩擦轮电机

图：摩擦轮驱动系统框图

由图，云台控制版输出PWM 波，需经由HG900电调模块驱动电机转动。电调相关工作模式配置在模块详细设计部分再详细说明。

RM6025驱动板CAN 帧

RM6025无刷电机

图：两轴云台驱动系统框图

由图，云台控制板通过CAN 通信协议与RM6025驱动板进行通信，控制信息以一个CAN 消息帧的形式传输。其中，由云台控制板到RM6025驱动板的CAN 帧内容为三轴驱动电流大小，但此处实际只用到了两轴电流大小的数据。由

RM6025驱动板到云台控制板的CAN 帧内容包括三轴实时驱动电流大小以及三轴当前绝对角度值，同理，这里我们只会用到其中两轴的相关数据。两轴云台的具体控制算法为位置式双闭环PID 控制算法，其具体设计在模块详细设计部分再详细说明。

3. 方案比较

控制算法比较与选择

云台的三闭环控制：

位置环和速度环是在云台主控里实现的，HG900驱动板中已经集成了电流环的控制，如下图：

图：云台PID 控制

（1）位置式PID 控制算法

比例积分微分⊕

⊕受控对象

输入信号

r(n)输出信号y(n)

_

图：数字PID 控制算法流程

PID 调节器是一种线性调节器，控制偏差定义为e(n) = r(n) – y(n)，并对该控制偏差作比例，积分，微分等运算，并将其各步运算结果作线性运算作为控制量输出，用于控制受控对象。其中PID 算法根据实现方式分为模拟式与数字式PID 算法。对于本系统，采用数字式PID 控制算法。其输出变量的离散表达式为：

()()???? ??--++=∑=k j D I p n e n e T T j e T T n e k n u 0))1()(()(

上式可以进一步简化为： ()))

1()(()()(0--++=∑=n e n e k j e k n e k n u k j d i p

其中，d i p k k k ,,分别称为比例常数，积分常数与微分常数，D I T T T ,,分别为系统采样时间，积分区间时间，微分区间时间。实际利用位置式PID 控制受控系统时，常采用经验值法或试凑法来分别调整d i p k k k ,,的大小，调整或改善系统控制性能。

PID 运算结果u(n)直接控制执行机构，在本系统中，该值对应着驱动两轴云台无刷电机的电流值大小，其缺点在于当前采样时刻的输出与过去的各个状态有关，计算时要对各个时刻的e(n)进行累加，运算量大，且由于控制器的输出u(n)对应的是直接驱动无刷电机的电流大小，因而若计算出现异常，u(n)的大幅度变化会引起云台运动的极其不稳定。其优点在于适用性广，易于实现且对于位置式控制方式的系统，系统适用性总体较强,控制效果较好。

（2）增量式PID 控制算法

相对于位置式PID ，增量式PID 控制器的输出只是控制量的增量)(n u ?，其对于位置式PID 算法的转化计算式为u(n) = u(n-1)+ )(n u ?。其输出变量离散表达式如下：

()()()1--=?n u n u n u

进一步展开得到：

()()()()()()()()()2121-+--++--=?n e n e n e k n e k n e n e k n u d i p 式中，d i p k k k ,,分别称为比例常数，积分常数与微分常数，e(n) = r(n) – y(n),为目标与输出量之差，称为控制偏差。

增量式PID 算法的优点在于，算式中不需要累加，输出)(n u ?的值仅仅与最近三次的采样值有关，容易通过加权处理获得较好的控制效果。另外，控制器每次只输出控制增量，即对应执行机构的位置的变化量，故而当机器偶然性故障时，影响范围相对于位置式PID 较小，不会严重影响系统的整体性能。再者，增量式PID 控制可以做到手动至自动切换冲击效应小，当控制器从手动向自动切换时，可以做到无扰动切换。

（3）棒棒控制算法

设定门限门限，在误差比较大的时候采用大输出控制电机，将误差在最短时间内减小到所要求的范围，这就是棒棒控制的思想。棒棒控制又称时间最优控制。设非线性时变系统的状态方程由下列微分方程描述：

()n n u n X f n X ),(),()(=?

初始条件为：

00)(X n X =

目标集条件为：

)}()(|)({)(n S n X n S n S ∈=

性能指标为：

01101)(n n n J n n n -==

∑=

控制u(n)是受限的，即：

M n u ≤|)(| 现在的问题是要求最优控制函数)(n u ∧

，使系统从0X 最快转移到终止状态J X ，受限控制)(n u j 的最优解为：

????

?????=>-<+=∧∧∧∧0)(,00)(,0

)(,)(n q n q M n q M n u j j j

棒棒控制的优点在于其在随动系统调转控制过程中能很好满足系统快速性的要求，达到阶跃过程最小化，并且结合其它控制方法能提高系统自适应能力和控制精度，有很好的推广价值。其缺点在于，阈值选取不当，可能会出现超调或严重回摆的现象，常常需要与其他控制算法配合使用。

三种算法主要优缺点比较如下图： 控制算法

性能比较

位置式PID 增量式PID 棒棒控制 优点

适用性广，易于实现 运算量小，误差影响小 系统响应快 缺点 运算量大 响应不快

阈值不当影响大 适合配合使用

图：PID 算法比较 综上所述，考虑到云台无刷电机是有绝对电流值大小来驱动，且其感官可控制量为其轴固定下来时的绝对角度，故而不可采用增量式PID 控制算法，位置式PID 算法相较于棒棒控制算法，尽管实现起来复杂程度较高，但总体性能上，可以做到响应速度与精度更高。再考虑到PID 算法已有资源更为丰富，在参考他人的调参数经验上，采用位置式PID 控制算法，将会更快取得较为理想的控制效果。故而，综合考虑，我们决定采用位置式PID 控制算法。

PID 算法改进方式选择

（1）基于生物遗传算法改进的模糊PID 算法

遗传算法是计算数学中用于解决最佳化的，是进化算法的一种。进化算法最初是借鉴了进化生物学中的一些现象而发展起来的，这些现象包括遗传、突变、自然选择以及杂交等。遗传算法通常实现方式为一种模拟。对于一个最优化问题，一定数量的候选解（称为个体）的抽象表示（称为染色体）的种群向更好的解进化。传统上，解用表示（即0和1的串），但也可以用其他表示方法。进化从完全随机个体的种群开始，之后一代一代发生。在每一代中，整个种群的适应度被评价，从当前种群中随机地选择多个个体（基于它们的适应度），通过自然选择和突变产生新的生命种群，该种群在算法的下一次迭代中成为当前种群。

遗传算法的基本运算过程如下:

a)初始化:设置进化代数计数器t=0，设置最大进化代数T，随机生成M个个体作为初始群体P(0)。

b)个体评价:计算群体P(t)中各个个体的。

c):将选择算子作用于群体。选择的目的是把优化的个体直接遗传到下一代或通过配对交叉产生新的个体再遗传到下一代。选择操作是建立在群体中个体的评估基础上的。

d)交叉运算:将交叉算子作用于群体。遗传算法中起核心作用的就是交叉算子。

e):将变异算子作用于群体。即是对群体中的个体串的某些上的基因值作变动。群体P(t)经过选择、交叉、之后得到下一代群体P(t+1)。

f)终止条件判断:若t=T,则以进化过程中所得到的具有最大个体作为输出，终止计算。

基于生物遗传算法改进的模糊PID算法，其优点在于总可以求得局部最优解，实时根据系统环境改变PID参数，从而改进系统的稳定性与响应速度。但其缺点在于，每次搜索最优解需要反复计算每个个体的适应度，计算量太大，可能给系统带来较大的延时。且适应度函数的确定直接关系着最优解的选取，为了达到好的参数选择效果，必须确定一个合适的适应度函数。

（2）基于分段的模糊PID算法

传统PID是用事先调好的一套PID参数施用在系统的整个控制过程中且保持不变。基于分段的模糊PID算法，在两轴云台的参数设计中，是根据当前两轴位置与目标位置的误差大小来分别确定一套适应性的PID参数，并基于该分段思想，将整个控制过程根据控制误差大小划分为多个区域，用多套参数随控制误差变化而变化，从而适应整个调节过程。

基于分段思想的模糊PID算法，其优点在于思路简单，实现过程没有复杂的计算过程，能够很好适应系统对时延的要求。对于测试环境并不过于复杂的情况，可以很好提高系统的适应性与稳定性。缺点在于如果系统测试环境较为复杂，必须将测试环境分为许多参数区间，增大参数的调试任务。

（3）基于权重分配改进的模糊PID算法

所谓基于权重分配改进的模糊PID算法，是在分段模糊PID算法的基础上，根据当前的控制误差与已有的各分段边界的距离，对距离做归一化和计算权重，距离越远，该段参数的值对最终值的形成影响便越弱。在权重的基础上，对各区间参数值作加权平均得到最终用于控制系统的PID参数。

该算法思想取自数字图像处理图像平滑算法思想。其优点在于，可以在很快

的响应时间内，得到实时变化的PID 参数，从而增强系统的鲁棒性。其缺点在于，最终得到的PID 参数适应性好坏很大程度取决于最初的基本分段参数的好坏，如果分段比较粗糙，通过加权平均得来的参数效果便会大打折扣。

（4）经微分现行，阈值控制等数学方式改进的PID 算法

1）不完全微分PID 算法。在中，微分信号的引入可改善系统的动态特性，但也易引起高频干扰，在误差扰动突变时尤其显出微分项的不是。若在控制算法中加人低通，则可使系统性能得到改善。

2）积分饱和及抑制。在实际过程中，控制变量乙因受到执行元件机械和物理性能的约束而控制在有限范围内，即min u ≤u （k ）≤max u 。如果由计算机给出的控制量形在上述范围内，那么控制可以按预期的结果进行。一旦超出上述范围，那么实际执行的控制量就不再是计算值，由此将引起不期望的效应。

① 遇限削弱积分法。一旦控制变量进入饱和区，将只执行削弱积分项的运算而停止进行增大积分项的运算。具体地说，在计算u （k ）时，将判断上一时刻的控制量u （k ）是否已超出限制范围。如果已超出，那么将根据偏差的符号，判断系统输出是否在超调区域，由此决定是否将相应偏差计人积分项。在三闭环控制程序的速度环中就应用了这个方法。

② 积分分离法。减小积分饱和的关键在于不能使积分项累积过大。上面的修正方法是一开始就积分，但进人限制范围后即停止累积。这里介绍的积分分离法正好与其相反，它在开始时不进行积分，直到偏差达到一定的阈值后才进行积分累计。这样，一方面防止了一开始有过大的控制量；另一方面即使进入饱和后，因积分累积小，也能较快退出，减少了超调。

综合考虑，基于遗传算法的模糊PID 算法计算量过大，会给系统带来较大的延时，不能满足系统对实时性的要求，故而不可用。另外，两轴云台系统的工作环境并不会有太大的波动，根据比赛场景预测，单次转动角度值应在30°以下，因而可采用分段模式下的模糊PID 算法。由于控制变量误差范围较小，分段已经可以满足系统适应性要求，若采用加权平均求取实时性PID 参数，会加大系统的计算任务，过分提高系统的参数的灵敏度，反而容易降低系统的抗干扰性能。最后，微分先行，阈值控制方式实现简单，可以有效抑制系统的超调，且调高系统的稳定性，故也可采用。

综上所述，本方案选择分段与微分现行、阈值控制等方式结合改进的PID 算法作为系统最终的控制算法。

四. 各模块工作原理（详细设计部分）

1. 串口通信协议设计

由系统框图可知，云台控制系统的串口通信协议设计涉及到与工控机的串口通信和与底盘主控的串口通信。

yaw轴角度（31~24位）yaw轴

角度

（23~16

位）

yaw轴

角度

（15~8

位）

yaw轴

角度

（7~0

位）

pitch

轴角度

（31~24

位）

pitch

轴角度

（23~16

位）

pitch

轴角度

（15~8

位）

pitch

轴角

度

（7~0

位）

校

验

字

节图：工控机到云台的消息帧结构图

其中，与工控机串口通信部分，云台控制部分需要接收来自工控机关于两轴云台的下一个目的位置，采用float型数据存储一个目的位置，即四个字节。两轴云台即一共八个有效数据字节。最后为了防止传输过程中出现数据位置错乱及数据错误丢失等问题，在八个有效字节后，追加一个字节作为校验位，期值大小为前八个有效数据字节的异或运算结果。其消息帧结构图如图。

云台控制中心到工控机只需要发送一个字节，0xAA表示需要火控部分切换目标，其他值表示无需切换目标。

另外，云台控制部分与底盘主控通信部分，云台控制台需要从底盘主控接收指令，指令内容包括两轴目标角度（遥控部分，有符号短整型数据），摩擦轮控制指令，是否开启火控，再加上起始字节，校验字节，一个消息帧包括5个字节内容。

起始字节yaw轴角度pitch轴角度控制指令字节校验字节

图：底盘主控到云台的消息帧结构

需要补充的是，上述消息帧结构建立在云台两轴电机都是用RM6025电机的情况下。最后部分射手采用了pitch轴电机使用舵机，yaw轴电机使用RM6025电机的设计，这种设计下，工控机与云台通信的消息帧结构不变，但底盘主控到云台控制的消息帧结构则有略微区别，即少了pitch轴角度字节且由云台控制板需要向底盘主控转发来自火控部分pitch轴的目标位置。而造成这一区别的原因

在于，舵机直接由底盘主控板PWM驱动控制。

2.弹药击发结构及驱动设计

图：发射机构

图为发射部分机械结构外观图，器件介绍如下：

①发射机构实际上是一个两轴的云台结构，两个轴yaw轴和pitch轴都是采用pmsm控制方式，由电机直接驱动；

②BLDC电机及电调，选用的是多旋翼动力电机，这种电机能高速运转，适合用来推挤子弹；

③拨送子弹进入弹道的电机选用普通的直流有刷减速电机，控制比较简单；

④单轴陀螺，做了滤波处理，有限时间内漂移不大云台发射装置由双摩擦轮挤压子弹弹射装置完成

⑤击发部分驱动设计主要任务在于摩擦轮电机的工作状态配置。

根据摩擦轮使用手册，首先向电机驱动接口输入占空比为1的PWM波，再重新上电，向电机驱动接口输入占空比为50%的PWM波，听到电调滴答声提示，判断是否进入正常工作状态，再最后根据转速需要输入不同占空比的PWM波，使摩擦轮电机以不同速度飞速转动。

3. 两轴云台运动控制

本系统云台控制部分采用改进的PID 算法，常规PID 参数的调节经验如下： 其中d i p k k k ,,分别称为比例常数，积分常数与微分常数，D I T T T ,,分别为系统采样时间，积分区间时间，微分区间时间，流程见图。

1)比例项系数p k 大,系统响应快,调节精度高;但p k 过大时,易造成系统超调,甚至不稳定。因此在大误差时采用大KP 值以提高系统响应速度;当系统接近稳态区域时, 要减小KP 值以防止超调,稳态时KP 值应适中。

2)积分项系数i k ,积分的作用主要是消除稳态误差,以提高系统调节精度。i k 值大,误差消除能力强,但在起动过程中易出现积分饱和现象,调节超调量增加。因此要求i k 在大误差时为0,以消除积分饱和现象;在中误差时,采用较小的积分系数;进入稳态区域时,相对加大积分系数。这样可实现变系数积分,既保证稳态时对积分的要求,又避免了积分饱和现象。

3)微分项系数d k 其主要作用是通过它对系统变化的抑制,达到改善系统动态特性的目的, 即起阻尼作用。d k 值大,阻尼性增强,因此在大误差时应使d k 为零, 即去掉阻尼作用以加快系统响应;当误差接近稳态区域时,应使d k 值为最大以抑制变化趋势,从而起到减少超调的目的;当系统进入稳态区域时,应选择适当的d k 使控制稳定。

云台运动软件流程思想如下图： 系统上电初始化

双摩擦轮初始化

是否收到底盘火控或

火控工控机的消息

消息优先级仲裁及

处理

摩擦轮速度等级更

新及云台位置更新

PID 算法控制云台

运动

N

Y

图：软件控制流程图

流程图中“云台位置更新”调试过程中主要根据系统由初始位置到达指定位置的振荡曲线，来判断PID 三个参数的大小取值是否恰当。

如下面两幅图保持d k 不变，只改变p k 参数时的系统振荡曲线对比：

图：p k =，d k =1 图：p k =1，d k =1

以及保持p k 不变，改变d k 时的系统振荡曲线图对比：

图：p k =1，d k = 图：p k =1，d k =3

分段PID ，不完全微分方式其具体实现，参见附录工程源代码部分。

五. 系统测试及调试

1.

联调。

视觉处理

两轴偏转

角

主控接收数据解析

两轴电机

控制

转交

串口

(1)

的队员完成。

(2) USB转串口测试

1> 在开发机上插入USB转串口小板，安装驱动后，在计算机—>管理面板中查看这一设备的编号，一般为COMX（X为数字）的形式。

2> 在开发机上运行“串口调试助手”程序，选定先前检测出的端口号，设定波特率115200B，其他设置保持默认，之后点击开始。

3> 将发送数据格式设为ASCII，发送任意内容，点击发送后，可以看到USB 转串口的TX灯闪烁。用导线将RX与TX短接，选择连续发送，点击发送后，可以看到接收窗口以一定周期接收发送的内容，而设备上的RX、TX指示灯保持同步闪烁。这里如果可以接收发送的消息说明串口通信正常，而如果指示灯也正常的话会更好，方便观察通信状况。否则说明USB转串口工作不正常，考虑重新接线或者换其他USB转串口设备。

(3) 云台控制单调

视觉处理系统发送的两轴角度数据是经过编码的，一次性发送8字节数据，云台控制部分一次只能接收一字节数据，在接收数据后进行解析。进行单独测试，

可以将开发机与云台主控通过串口连接，在开发机上运行串口调试助手，仿照视觉识别系统发送的数据帧格式发送数据，主控板接收一个完整的数据帧后，解析出两轴角度，通过串口打印出结果，在串口调试助手的接收串口可以看到打印信息，验证解析结果是否正确，再验证云台是否转动到指定位置，确认这一部分工作正常后进行联调。

(4) 联调

以上三部分单调完成后，进行联调，视觉处理系统自动进行视觉处理、数据发送，云台控制部分接收数据后及时处理，自动调节两轴电机。在摄像头面前移动目标，测试云台是否转动到对准目标的位置。根据联调的效果确定改进方向，重复测试，直至达到预期效果。

(5)此部分遇到的问题和解决方案

1> 相对角度与绝对角度；

视觉处理系统根据摄像头视野中目标所处的相对位置确定要偏转的角度，这是相对于当前位置而言的，当前位置即基准角度是无法由视觉识别系统自己确定的；对云台两轴电机进行自动控制时，需要向电机驱动发送绝对角度，然后电机驱动通过电流闭环控制电动机转动到指定位置。这里可以在视觉识别系统上加上陀螺仪自己测量当前角度，或者由云台反馈会基准角度数据，这两种方法分别会增加系统复杂度和降低数据传输效率。最简单的方法是在云台控制程序中增加两个变量保存基准角度，及时更新这两个变量，在接收视觉识别系统的相对角度后加上基准角度，得到绝对角度，转交两轴电机控制部分完成。经过测试这一方法可以很好地解决两种数据之间的转换问题。

2> 转动角度的范围控制；

由于视觉系统不知道当前角度，会尝试转到任意角度，而受导线束缚、机械结构影响，转动范围是有限的，否则可能导致导线松开、电流过大烧毁电机，因此需要解决转动角度的范围控制问题。从三方面解决，一是在布线时选择合适长度的导线；二是在安装电机时调整合适的位置（每个电机有三种安装位置）；三是在云台控制程序中，判断目标绝对角度，如果超过了范围，则将目标角度设为可转到的最大安全角度。通过综合这三种解决方法，确保了转动角度处于安全范围内。

2. 其他的问题以及解决方案

、云台运行噪声问题；

问题描述：在云台运行过程中，经常出现“吱吱”类似烧开水的声音，声音来源来自两轴云台电机内部。

问题分析：这种声音，明显表明电机工作不正常，存在磨损情况。即，电机不能在一个位置稳定下来，即在平衡位置存在振荡问题。另一方面，源自机械装置固定不紧密，部分连接处螺丝随云台抖动而松动，与金属杆碰撞发出的声音。

解决方案：经多方调整参数，最后得出噪声明显减少的参数调整方案，即内环调节参数不能过大，在本系统中，内环指电流环，外环指位置环。通常情况下，内环参数在数值上不能超过5。在这种情况下，再去调整位置环三参数大小，噪声会明显减小。另外d k参数不能过大（例如1500及其以上），否则会产生明显噪声。最后，配合使用分段参数，不完全微分等算法改进方式，增大参数的试用范围，进而增强系统的稳定性，减少异常情况产生。

、 pitch轴电机运动不稳定，工作电流过大问题；

问题描述：在pitch轴前端，绑上金属材质激光灯以及一个摄像头之后，云台部分横向中心明显靠前，pitch轴电机“抬头”电流一般达到3A峰值仍不能将炮管抬起并稳定到正常高度，根本原因在于MPU6025电机力矩过小，不能适应当前重心大幅度靠前的重心环境。

问题分析：主要是由于机械设计时，并没有考虑到重心均衡的问题。

解决方案：最终临时采用的解决方案为，在继续采用RM6025电机作为pitch

轴电机的情况下，在弹仓尾部额外挂载一个重物，起重心匹配作用。另外，pitch 轴电机采用舵机替换RM6025电机，由于舵机的力矩为45kg/cm,完全适应当前情况，大大提高了pitch轴的稳定度。

、串口通信数据串扰及数据错误问题；

问题描述：经常出现数据接收错误或字节顺序错误从而导致两轴角度译码错误，使云台出现异常抖动的情况。

问题分析：由模块工作原理中的串口通信设计部分可知，一个消息帧往往不止一个字节，而一个消息帧内的每个字节都有严格的接收顺序要求。若没有添加起始字节和校验字节，接收方易出现数据串扰或字节顺序错误。

解决方案：后来通过在消息帧内加入起始字节和校验字节，接收到错误字节，直接丢弃，避免错误消息帧影响系统正常运转，从而解决了该问题。

六. 项目实施总结及心得体会

这是我们团队第一次接触到机器人相关的设计类竞赛，对于每一个人来说这都是一次宝贵的历练和难忘的经历。我们小组想从不同的角度谈一谈对于此次项目的总结和体会。

从项目的时间进展上讲，我们在2014年底就已经接触了这个项目，宣讲会和视频过后，大家对项目初步的印象就是有趣新颖，表面上是机器人战车之间的博弈，实际上融合了机械以及软硬件等不同领域的设计并用一种类似于CS游戏的形式呈现出来；在有了大疆提供的资料后，我们开始了机械、火控、硬件组的分工，身处硬件组，我们感受到每一部分从PCB板的焊接测试到软件的调试下载都是很大的挑战，除了工作量大，缺乏经验的我们很多时间都是用在寻找解决问题方案上。直到五月份我们还会出现板子莫名被烧的窘况，直到比赛前几天晚上大家也都在熬夜完善代码......但是只要大家坚持总会柳暗花明。

从项目的分块实施上，我们这个项目的团队毕竟是临时组建的，初期肯定需要一定的磨合，但每位成员也都在努力寻找合适的定位。从任务零散到逐渐模块化，我们在小组合作和突破问题中逐渐找到默契和成就感。例如云台部分的调试，CAN通信失败是由于芯片问题，板子烧毁问题，小车布线问题，云台部分是由于电机问题，控制板问题，控制算法问题，参数问题等，找到问题所在就是成功的第一步，然后集思广益、不断调试，当第一次看到车随遥控行走，第一次看到云台随着鼠标转动，第一次与火控联调成功......我们逐渐找到信心，团队的合作力量也愈发强大。

从项目的比赛结果上，两天比赛下来打了第4 名拿到总决赛入场券，是对我们所有老师和同学付出的一种肯定。经历了几场连续的胜利之后，我们觉得这么久的付出也值了。从名次上讲，这是一个比较符合我们队实际情况的名次。就像步兵1号的学长所总结的，我们之所以止步于第4有如下几点：

①我们的战术缺陷：进攻路线单一，步兵爬不上A高台，死亡桥不敢走，对面派一个车堵在B帘什么都不做，两辆主攻的步兵就只能干瞪眼（反观我们赢的7 局比赛里，共同点是步兵都是钻B 帘出去的）。针对这种战术，其他的队伍不难想出应对我们的办法。

②我们也缺乏实战经验，当这套战术废了之后，操作手们短时间内不知所措，等到反应过来步兵要回去打防守反击战，已经来不及了。

③我们的技术短板，毕竟前三名的队，哨兵基本都能爬上去，射手和炮手