《两轴云台及击发控制的设计与实现》由会员分享，可在线阅读，更多相关《两轴云台及击发控制的设计与实现（24页珍藏版）》请在金锄头文库上搜索。
1、 1RoboMasters 机器人大赛机器人大赛两轴云台及击发控制的设计与实现两轴云台及击发控制的设计与实现2目录目录一. 项目概述.41. 比赛简介.42. 课题简介.4二. 项目目标.51. 基本功能与性能.52. 扩展功能与性能.5三. 系统设计方案.51. 系统框图.52. 子系统框图.63. 方案比较.73.1、控制算法比较与选择.73.2、PID 算法改进方式选择.10四. 各模块工作原理（详细设计部分）.1231. 串口通信协议设计.122. 弹药击发结构及驱动设计.133. 两轴云台运动控制.14五. 系统测试及调试.161. 以云台控制视觉识别为例介绍测试流程.162. 其他
2、的问题以及解决方案.182.1、云台运行噪声问题. 182.2、pitch 轴电机运动不稳定，工作电流过大问题. 182.3、串口通信数据串扰及数据错误问题. 19六. 项目实施总结及心得体会.17七. 致谢.20八. 参考文献.21九. 附录.211. 电路图.222. 源工程详见附件.234一. 项目概述1. 比赛简介RoboMasters 是一项全新的机器人超级对抗赛。参赛队伍通过自行设计制造多种机器人进行射击对抗，完成指定任务，由比赛裁判系统判定比赛胜负。参赛机器人包括可以发射“弹丸”的手动机器人以及能够完成一定任务的自动机器人。参赛队员需要遥控手动机器人在复杂的场地中移动并发射“弹丸
3、”，攻击对方机器人和基地以取得胜利。自动机器人将在比赛中自动完成指定任务。每场比赛双方最多可各有 6 台机器人上场参与对抗，每队的编制是 2 台机器步兵、2 台机器射手、1 台机器炮手和 1 台机器哨兵。2 台机器步兵由比赛组委会提供，其余机器人均由参赛队员自行设计制作完成。比赛采用红、蓝双方对抗的形式，每场比赛采用多局制，每局限时 5 分钟。2. 课题简介5图图 1.1：战车主要模块分布图：战车主要模块分布图本项目基于 STM32F405 开发平台，主要利用位置式双闭环 PID 控制算法，实现对两轴云台的运动以及发弹的控制。云台控制板通过串口分别与主控板及工控机进行通信，从底盘主控板或工控机
4、获取两轴云台运动指令及发射子弹指令，再经由电流环、位置环双闭环PID 控制算法，精确控制云台运动模式，并尽可能快、尽可能稳地使两轴云台达到目标位置；同时通过输出不同占空比 PWM 波，驱动并控制双摩擦轮转速，达到发射子弹的要求。二. 项目目标1. 基本功能与性能 （1）通信部分：通信部分：云台控制部分能够通过串口与底盘主控和工控机正常通信，正常接收与传送数据或指令。（2）云台运动：云台运动：两轴云台可以按照指定指令，快速到达规定角度位置，并稳定下来。（3）子弹发射：子弹发射：可以正常驱动双摩擦轮，并以固定速度发射子弹。2. 扩展功能与性能（1）串口通信在正常通信的情况下，要在满足系统对通信速率
5、的要求下，设计相应具有查错或纠错能力的通信协议，使误码率尽可能低，提高通信的稳定6性。（2）两轴云台在满足系统对稳定性的要求下，改进系统参数，要求尽可能提高对系统指令的响应速度。（3）在实现以单一速度驱动双摩擦轮的基础上，实现根据底盘指令，变速控制双摩擦轮，多级调速，满足不同对战环境下的发射子弹速度要求。三. 系统设计方案1. 系统框图 图图 3.13.1：系统框图：系统框图由图 3.1，云台控制部分处于整个通信系统的中心：一方面，云台控制中心需要通过串口与底盘主控进行通信，接收来自操作手通过遥控器转发过来的关于云台的相关指令；另一方面，云台控制中心需要通过串口与火控部分工控机进行直接通信，接
6、收在自动瞄准过程中的云台自动调整功能，这一部分的设计由于环境等因素在区域赛中没有起到作用。特别地，在炮手系统设计中，云台控制中心还要负责转发工控机关于底盘自适应性运动的相关指令，控制底盘运动，如下图：图图 3.23.2：炮手通信：炮手通信2. 子系统框图7子系统主要涉及到摩擦轮驱动部分以及两轴云台驱动部分。具体框图如下：HG900电调PWM波摩擦轮电机图图 3.33.3：摩擦轮驱动系统框图：摩擦轮驱动系统框图由图 3.3，云台控制版输出 PWM 波，需经由 HG900 电调模块驱动电机转动。电调相关工作模式配置在模块详细设计部分再详细说明。RM6025驱动板CAN帧RM6025无刷电机图图 3
7、.43.4：两轴云台驱动系统框图：两轴云台驱动系统框图由图 3.4，云台控制板通过 CAN 通信协议与 RM6025 驱动板进行通信，控制信息以一个 CAN 消息帧的形式传输。其中，由云台控制板到 RM6025 驱动板的 CAN 帧内容为三轴驱动电流大小，但此处实际只用到了两轴电流大小的数据。由 RM6025 驱动板到云台控制板的 CAN 帧内容包括三轴实时驱动电流大小以及三轴当前绝对角度值，同理，这里我们只会用到其中两轴的相关数据。两轴云台的具体控制算法为位置式双闭环 PID 控制算法，其具体设计在模块详细设计部分再详细说明。3. 方案比较3.1 控制算法比较与选择控制算法比较与选择 云台的
8、三闭环控制：位置环和速度环是在云台主控里实现的，HG900 驱动板中已经集成了电流环的控制，如下图：8图图 3.5：云台：云台 PID 控制控制（1）位置式 PID 控制算法 比例积分微分受控对象输入信号 r(n)输出信号 y(n)_图图 3.63.6：数字：数字 PIDPID 控制算法流程控制算法流程PID 调节器是一种线性调节器，控制偏差定义为 e(n) = r(n) y(n)，并对该控制偏差作比例，积分，微分等运算，并将其各步运算结果作线性运算作为控制量输出，用于控制受控对象。其中 PID 算法根据实现方式分为模拟式与数字式 PID 算法。对于本系统，采用数字式 PID 控制算法。其输出
9、变量的离散表达式为： kjDIpneneTTjeTTneknu0)1()()(上式可以进一步简化为： )1()()()(0 nenekjekneknukjdip其中，分别称为比例常数，积分常数与微分常数，分别dipkkk,DITTT,为系统采样时间，积分区间时间，微分区间时间。实际利用位置式 PID 控制受控系统时，常采用经验值法或试凑法来分别调整的大小，调整或改善dipkkk,系统控制性能。9PID 运算结果 u(n)直接控制执行机构，在本系统中，该值对应着驱动两轴云台无刷电机的电流值大小，其缺点在于当前采样时刻的输出与过去的各个状态有关，计算时要对各个时刻的 e(n)进行累加，运算量大，且由于控制器的输出 u(n)对应的是直接驱动无刷电机的电流大小，因而若计算出现异常，u(n)的大幅度变化会引起云台运动的极其不稳定。其优点在于适用性广，易于实现且对于位置式控制方式的系统，系统适用性总体较强,控制效果较好。（2）增量式 PID 控制算法相对于位置式 PID，增量式 PID 控制器的输出只是控制量的增量，)(nu其对于位置式 PID 算法的转化计算式为 u(n) = u(n-1)+ 。其输出
