安徽建筑工业学院本科毕业设计(论文)
3.7本章小结
主要DSP控制系统电路设计做了系统设计包括控制电路系统结构、MCU模块设计、主从工作模式下的软件设计、驱动电路模块的设计,主DSP对从DSP进行控制和管理,双DSP配合,完成速度跟随控制、无限通讯、传感器数据读取等任务
36
安徽建筑工业学院本科毕业设计(论文)
第四章 足球机器人的控制对象建模
因为足球机器人比赛是在高速对抗中进行,要求机器人运动准确、快速、灵活,因此对机器人运动控制非常重要。同时足球机器人比赛系统是个群体机器人协调作战系统,如同人类足球竞技比赛一样,每个机器人不仅要充当整体角色中的一员,而且自身也要具备很强的单兵作战能力。机器人控制系统是保证机器人跑位、带球、传球、截球、阻挡、射门、战术配合等一系列技术动作得以完美实现的关键环节。控制系统要以最优的控制方式来完成比赛过程中的各种技术动作,所谓的最优控制是指:两个动作之间的平稳切换、动作组合、运动惯性的控制、电机特性控制、路径规划、快速准确的定点移动等。 4.1控制系统总体设计
足球机器人是一个惯性系统,具有一定的超调响应和滞后效应。在比赛过程中机器人始终处于动态,同时要求速度快、运动稳定和准确等,但是对于惯性系统而言两者是矛盾的,速度越快,系统的惯性越严重,控制比较困难。图4-1是足球机器人的控制系统框图。
。 图 4-1足球机器人控制系统框图
37
安徽建筑工业学院本科毕业设计(论文)
主控单元采用DSP作为系统的处理器,接收场景信息并处理,进行整体战术决策分析。姿态控制部分由MPU和电机驱动电路组成,电机采取PWM调速,各种传感器信息同时反馈到DSP和MPU系统,实现对机器人运动精确控制
控制系统是机器人运动的核心,机器人的每一个动作都需要经过决策、姿态控制、电机运行、信号检测循环过程。其中决策和姿态控制联系非常紧密,两者之间是相辅相成。机器人的许多动作,例如走直线、转弯、射门、带球、传球等动作既可以在决策中完成,也可以在姿态控制部分完成,两者都需要占用较多的CPU运算时间。这些都给机器人控制系统的设计带来了难题。为了解决好决策与姿态控制之间的关系,解决好多机器人协调控制所带来的问题,我采用分级控制的处理方法。所谓分级控制就是将控制系统分为组织级、协调级和执行级三级对机器人进行控制,使得整个系统运行更加快速、灵活、准确。三级之间采用一些接口参数进行彼此联系。图4-2是足球机器人控制系统的三级结构图:
图4-2 足球机器人控制系统的三级结构图
4.2足球机器人的动力学建模
38
安徽建筑工业学院本科毕业设计(论文)
控制系统的好坏关系到决策系统指令执行的好坏,所以如何根据电机的特性、自身运动状态、控制命令等信息生成比较好的控制运动指令,从而实现控制目标。这都依赖于系统控制方程的建立。控制方程包括动力学方程和运动学方程,而控制方程的好坏往往依赖于所控制球机器人的动力学建模。
为了分析轮子对机器人运动性能的具体影响,我们以单个轮子的运动分析它的具体工作原理(见图4-3)假设一个电机上配一个减速比为I:1的减速箱驱动一个轮子在地面上滚动,电机经减速后的输出扭矩T可表示
T?i?(?0U??0?0)??U???控制的足
( 4-7)
2其中
???0i,??i??0,??i??
U是电机电压,?0是电机转速,?表示减速效率,?0,?0均为电机常数。此时,轮的加速度可表示为;
J??T?fl
( 4-8)
其中J表示轮子的转动惯量,l表示轮子的半径,f为轮子与地面的摩擦力。 M为质量, g为重力加速度,G为重力,?为摩擦系数。
图4-3 轮子动力学分析
首先分析摩擦系数的影响。考虑两种情况:电机功率有限和摩擦系数有限。电
39
安徽建筑工业学院本科毕业设计(论文)
机功率有限时指电机以最大电压工作的情况下轮子不会打滑。
首先分析电机功率有限情况。在不打滑的情况下,满足线加速度a??l?结合公式(4-7)和公式(4-8)可得
f?M?lU??Ml?J?Ml2fM,
?M?lJ?Ml22U??MlJ?Ml2?
???J?Ml2U??J?Ml ( 4-9)
? ( 4-10)
当电压保持为额定电压不变时,电机输出扭矩T,地面摩擦力f, 。由式4-9知道,摩擦力f随着转速w的增加而减小,当加速过程结束,即摩擦力减为0时,轮子的最大转速为
?max??Ul???0Uli?0 ( 4-11)
为了保证不打滑,在电压一定的情况下,需满足在初始时刻摩擦力足够,由此可推出 ??i??0Ul? (4-12) 22(J?Ml)g(J?Ml)g?Ul由此可知,电压越高,减速比越大 ,则摩擦力就越大,轮子的加速度就越大,但是,随着电压和减速比的增加,对摩擦系数的要求越来越大。
近两年来各队纷纷采用了大功率的电机组合,由此造成的直接结果是轮子的摩擦系数很难带到让机器人不打滑的要求,因此,在实际设计过程中碰到的往往是摩擦系数有限的情况,据此可将分析分为两个阶段。初级打滑阶段和不打滑阶段。在打滑阶段f= fmax??Mg ,在不打滑阶段满足, ?l?两者的分界点为 ?l?fmMaxfM
??g 结合4-7 4-8可
40
百度搜索“77cn”或“免费范文网”即可找到本站免费阅读全部范文。收藏本站方便下次阅读,免费范文网,提供经典小说综合文库足球机器人控制系统设计(8)在线全文阅读。
相关推荐: