全向移动机器人的运动控制毕业设计

全向移动机器人的运动控制

毕业设计（论文）原创性声明和使用授权说明原创性声明本人郑重承诺：所呈交的毕业设计（论文），是我个人在指导教师的指导下进行的研究工作及取得的成果。尽我所知，除文中特别加以标注和致谢的地方外，不包含其他人或组织已经发表或公布过的研究成果，也不包含我为获得及其它教育机构的学位或学历而使用过的材料。对本研究提供过帮助和做出过贡献的个人或集体，均已在文中作了明确的说明并表示了谢意。作者签名：日期：指导教师签名：日期：使用授权说明本人完全了解大学关于收集、保存、使用毕业设计（论文）的规定，即：按照学校要求提交毕业设计（论文）的印刷本和电子版本；学校有权保存毕业设计（论文）的印刷本和电子版，并提供目录检索与阅览服务；学校可以采用影印、缩印、数字化或其它复制手段保存论文；在不以赢利为目的前提下，学校可以公布论文的部分或全部内容。作者签名：日期：

学位论文原创性声明本人郑重声明：所呈交的论文是本人在导师的指导下独立进行研究所取得的研究成果。除了文中特别加以标注引用的内容外，本论文不包含任何其他个人或集体已经发表或撰写的成果作品。对本文的研究做出重要贡献的个人和集体，均已在文中以明确方式标明。本人完全意识到本声明的法律后果由本人承担。作者签名： 日期：年月日学位论文版权使用授权书本学位论文作者完全了解学校有关保留、使用学位论文的规定，同意学校保留并向国家有关部门或机构送交论文的复印件和电子版，允许论文被查阅和借阅。本人授权大学可以将本学位论文的全部或部分内容编入有关数据库进行检索，可以采用影印、缩印或扫描等复制手段保存和汇编本学位论文。涉密论文按学校规定处理。作者签名： 日期：年月日导师签名：日期：年月日

注意事项1.设计（论文）的内容包括：1）封面（按教务处制定的标准封面格式制作）2）原创性声明3）中文摘要（300字左右）、关键词4）外文摘要、关键词5）目次页（附件不统一编入）6）论文主体部分：引言（或绪论）、正文、结论7）参考文献8）致谢9）附录（对论文支持必要时）2.论文字数要求：理工类设计（论文）正文字数不少于1万字（不包括图纸、程序清单等），文科类论文正文字数不少于1.2万字。3.附件包括：任务书、开题报告、外文译文、译文原文（复印件）。4.文字、图表要求：1）文字通顺，语言流畅，书写字迹工整，打印字体及大小符合要求，无错别字，不准请他人代写2）工程设计类题目的图纸，要求部分用尺规绘制，部分用计算机绘制，所有图纸应符合国家技术标准规范。图表整洁，布局合理，文字注释必须使用工程字书写，不准用徒手画3）毕业论文须用A4单面打印，论文50页以上的双面打印4）图表应绘制于无格子的页面上5）软件工程类课题应有程序清单，并提供电子文档5.装订顺序1）设计（论文）2）附件：按照任务书、开题报告、外文译文、译文原文（复印件）次序装订

指导教师评阅书指导教师评价：一、撰写（设计）过程1、学生在论文（设计）过程中的治学态度、工作精神□优□良□中□及格□不及格2、学生掌握专业知识、技能的扎实程度□优□良□中□及格□不及格3、学生综合运用所学知识和专业技能分析和解决问题的能力□优□良□中□及格□不及格4、研究方法的科学性；技术线路的可行性；设计方案的合理性□优□良□中□及格□不及格5、完成毕业论文（设计）期间的出勤情况□优□良□中□及格□不及格二、论文（设计）质量1、论文（设计）的整体结构是否符合撰写规范？□优□良□中□及格□不及格2、是否完成指定的论文（设计）任务（包括装订及附件）？□优□良□中□及格□不及格三、论文（设计）水平1、论文（设计）的理论意义或对解决实际问题的指导意义□优□良□中□及格□不及格2、论文的观念是否有新意？设计是否有创意？□优□良□中□及格□不及格3、论文（设计说明书）所体现的整体水平□优□良□中□及格□不及格建议成绩：□优□良□中□及格□不及格（在所选等级前的□内画“√”）指导教师：（签名）单位：（盖章）年月日

评阅教师评阅书评阅教师评价：一、论文（设计）质量1、论文（设计）的整体结构是否符合撰写规范？□优□良□中□及格□不及格2、是否完成指定的论文（设计）任务（包括装订及附件）？□优□良□中□及格□不及格二、论文（设计）水平1、论文（设计）的理论意义或对解决实际问题的指导意义□优□良□中□及格□不及格2、论文的观念是否有新意？设计是否有创意？□优□良□中□及格□不及格3、论文（设计说明书）所体现的整体水平□优□良□中□及格□不及格建议成绩：□优□良□中□及格□不及格（在所选等级前的□内画“√”）评阅教师：（签名）单位：（盖章）年月日教研室（或答辩小组）及教学系意见教研室（或答辩小组）评价：一、答辩过程1、毕业论文（设计）的基本要点和见解的叙述情况□优□良□中□及格□不及格2、对答辩问题的反应、理解、表达情况□优□良□中□及格□不及格3、学生答辩过程中的精神状态□优□良□中□及格□不及格二、论文（设计）质量1、论文（设计）的整体结构是否符合撰写规范？□优□良□中□及格□不及格2、是否完成指定的论文（设计）任务（包括装订及附件）？□优□良□中□及格□不及格三、论文（设计）水平1、论文（设计）的理论意义或对解决实际问题的指导意义□优□良□中□及格□不及格2、论文的观念是否有新意？设计是否有创意？□优□良□中□及格□不及格3、论文（设计说明书）所体现的整体水平□优□良□中□及格□不及格评定成绩：□优□良□中□及格□不及格教研室主任（或答辩小组组长）：（签名）年月日教学系意见：系主任：（签名）年月日

关键词：移动机器人和自主系统，系统辨识，执行器饱和，路径跟踪控制。摘要：本文主要关注全向移动机器人的运动控制问题。一种基于逆运动学的新的控制方法提出了输入输出线性化模型。对执行器饱和及驱动器动力学在机器人性能体现方面有重要影响，该控制法考虑到了以上两个方面并保证闭环控制系统的稳定性。这种控制算法常用于真实世界的中型组足球机器人全方位的性能体现。1.介绍最近，全方位轮式机器人已在移动机器人应用方面受到关注，因为全方位机器人“有一个满流动的平面，这意味着他们在每一个瞬间都可以移动，并且在任何方向都没有任何调整”。不同于非完整的机器人，例如轮式机器人，在执行之前具有旋转任何所需的翻译速度，全方位机器人具有较高的机动性并被广泛应用在动态环境下的应用，例如在中型的一年一度的足球比赛。大多数移动机器人的运动控制方法是基于机器人的动态模型或机器人的运动学模型。动态模型直接描述力量施加于车轮和机器人运动之间的关系，以外加电压的每个轮作为输入、以机器人运动的线速度和角加速度作为输出。但动态变化所造成的变化的机器人惯性矩和机械组件的扰动使控制器设计变得较为复杂。假设没有打滑车轮发生时，传感器高精度和地面足够平坦，由于结构的简单，因而运动模型将被广泛应用于机器人的设计行为中。作为输入运动学模型是机器人车轮速度，输出机器人的线速度和角速度，机器人的执行器的动力都快足以忽略，这意味着所需的轮速度可以立即达到。然而，该驱动器的动态极限，甚至降低了机器人在真实的情况中的表现。另一个重要方面是机器人控制的实践：执行器饱和。因机器人轮子的指挥电机速度是有饱和的界限的，执行器饱和能影响到机器人的性能，甚至使机器人运动变得不稳定。本文提出了一个全方位的机器人的一种运动控制方法，这种控制方法是基于逆输入输出的线性的运动学模型。它需要不仅考虑到驱动器动力学的识别，但也需要考虑到执行器饱和控制器的设计，并保证闭环控制系统系统稳定性。本文其余的部分：在2节介绍了运动学模型的一个全方位的中型足球机器人；在3节介绍了路径跟踪与定位跟踪问题基于逆运动学模型的输入输出线性化的解决方法，其中包括执行器饱和分析；4部分介绍了动态识别器及其在控制性能方面的影响；最后的实验结果和结论讨论部分分别在5和6。2.机器人运动学模型移动机器人其实是一个全方位机器人，其原理显示在图1。它有三个彼此120度对称安装的瑞典的车轮。每个车轮的驱动用直流电机和具有相同距离的中心到机器人的质心。图一：运动图学基础上的全方位机器人除了固定的坐标系统，一个移动机器人的固定框架被定义在，该框架平行于地面，其起源定位于。是指机器人的定位，该方向的轴就在这个坐标系中。和分别是机器人观察视野的平移速度与机器人坐标系统。该运动学模型在机器人的坐标系统的体现为：=1\*GB3①观察到机器人坐标系统是机器人的速度向量，和是机器人的平移速度；是机器人的旋转速度，是车轮速度矢量，是车轮的线速度，它等于车轮半径乘以通过车轮的角速度。介绍了从机器人坐标系统到固定坐标系统的变换矩阵=2\*GB2⑵该运动学模型关于固定坐标系可推导出：=3\*GB2⑶是机器人关于固定坐标系统的速度向量；和是机器人的平移速度；是机器人转动速度；是指车轮定位在机器人坐标系统上且等于30度。重要的是要注意到变换矩阵是模型1是满秩矩阵，这意味着机器人的平移和旋转是被分解了的，并保证单独控制这两个方向上的运动。针对高电平控制法没有考虑到车轮速度，运动学模型=4\*GB2⑷被用在控制方法中，这里的变换矩阵等于，因为是满秩矩阵，这两个分解运动的特征也是被保持的。3.逆输入输出的线性化控制三角函数的变换角所在的变换矩阵确定了非线性的运动学模型4。由于矩阵是满秩，这种非线性模型可以精确线性化的引入一个简单的补偿。该线性化系统就变成了与一个新的输入向量。图2：在组成下的线性化系统这种线性化系统显示在图2中是完全分离的，允许控制的机器人通过一个单独的方式平移和旋转。当一个控制器的设计是基于这个简单的线性系统时，该控制器相对于原系统就变成了。整个控制回路，其中包括非线性系统，补偿和控制器，这一关系显示如图3。图3：闭环控制系统代表机器人的状态向量且代表的是理想状态向量；与是机器人在固定坐标系统中的位置。基于输入输出线性化系统，关于机器人的平移和旋转控制的路径跟踪和定位跟踪问题在下面的小节进行了分析。执行器饱和的影响也保持着平移和旋转运动之间的分解关系。3.1路径跟踪控制作为一个高层次控制问题，路径跟踪被应用于本例中的处理机器人平移控制。路径跟踪问题如图4所示。代表所给定的路径，点是正交设计在路径上的交点，路径坐标系统分别是沿着路径移动和坐标轴和对应的切线和法线方向上的点和它们的交点。是路径切线方向在点的水平夹角。图4路径跟踪问题的图解基于以上的叙述，路径跟踪问题用来寻找适当的机器人的速度和角速度的控制值的，这样偏移距离与角的误差趋向于零。为了解决这个问题，一个Lyapunov候选函数=5\*GB2⑸可以被考虑到，其中与是正常量。在该瞬间的求导结果为=6\*GB2⑹Mojaev提出了一个简单的基于偏移距离的控制律，被控制着沿着一个指数曲线并收敛于轴。该指数曲线可表示为（7）是初始偏差和正的常数确定的收敛速度的偏差。关于区别于（7），我们可以得到该指数曲线的切线方程为（8）因此，对于一个非零常数所需的速度，机器人的坐标系统的平移速度分别为，（9）；（10）将=8\*GB2⑻代入=6\*GB2⑹，我们可以得到因为且。该解决方案可保证在及情况下整体稳定的平衡力，这意味着这种控制律可解决路径跟踪问题。转换到总坐标系的机器人速度，我们可以得到线性化系统的控制值（12）（13）其中。控制器的输入12和13是点和给定的路径之间的偏差距离，通过该距离通常可以直接得到在机器人上的传感器。此外，该偏差平稳地收敛于零且速度受控于参数，这便是可以根据性能选择的要求。3.2定位跟踪不同于一个轮式机器人，在不同的角度上全方位机器人的定位方向是不同的，其关系可表示为。这意味着全方位机器人当它作路径跟踪时能跟踪任何角度。基于线性化模型，该定位跟踪的任务是寻找一个合适的，其值等于机器人的旋转速度，这样便可得=14\*GB2⒁，其中是期望的定位。输入变量与输出变量之间的系统是一个整体，普遍应用于PD控制器的设计并能圆满完成定位跟踪任务。3.3执行器饱和基于逆输入输出线性化，该全向机器人平移和旋转可以轻松通过一个单独的方式实现。该线性化就投入产出的关系而言，就要求内部零件有充足的能力去达到预期的输入。不过，机器人的电力马达是有界的，因而当指挥速度太大时执行器将会饱和。驱动饱和的存在可以影响机器人的平移和旋转这两个分解运动的速度，这样系统性能和稳定性就会受到严重影响。因此，在控制器的设计中有必要处理执行器饱和问题。对于全向机器人来说，每一轮的最大速度是的极限是，即。将上述控制值方程（12）（13），代入逆运动学模型（2）和（1）中，可得出车轮速度的计算值为：=15\*GB2⒂为了在路径跟踪控制的基础上实现定位跟踪，所需的平移速度的最大值被假定小于。将代入（15），可以计算得出每个轮子速度的上界和下界，其计算可表示为以下三个不等式，=16\*GB2⒃然后，动态边界值可计算得=17\*GB2⒄其中和分别是下界和上界。考虑饱和函数=18\*GB2⒅和它的增益特性如图5所示，我们可以得到一个动态增益饱和，当输入饱和时该值具有一个最大值且收敛于零。然后机器人定位的闭环控制系统可以表达为图6，其中一个控制器能用于控制机器人的定位收敛于理想值，（19）其中和分别是比例值和偏移量。它可获得闭环只有一个极点和一个零点。因此，当是负值，是被选择的时，这样极点就变成为负值，从而无论如何降低闭环系统的稳定性都可以被保证。图5：饱和函数和它的增益特性。图6：机器人定位的闭环控制。4.驱动器的动态当我们假设低电平驱动器动力学速度快于比运动学的速度时，这个结果在最后一节是唯一可行的，或驱动器动力的延迟可以被忽略。因而有必要在控制器的设计中分析和考虑驱动器的动态影响。在下面的小节中，在观察输入输出的数据的基础上的执行器的动态识别，和其在机器人运动控制方案上的影响将被一一叙述。4.1执行器动力识别该系统识别问题的目的是估算一个在观察输入输出数据基础上的模型从而得出性能指标最小化。因为满秩变换矩阵在低电平动力模型（1）表示的输出和是不相关的，对于一个普遍应用的参数模型，是被选择的模型识别，其结构可表示如下=20\*GB2⒇（21）（22）（23）代表从输入到输出间的延迟，是一个干扰变量。是产生于转变操作的结果，分别是多项式的次数，为了选择这个模型的最优参数，我们使用预报误差法，其目的是去寻找最优的和多项式，这样预测误差便是最小的，即，（24），（25）其中代表输出变量的测量值。Matlab系统识别工具箱被用来确定执行器动力学模型。图7、8和9显示就实际输入比较模型输出与测量输出之间的最佳参数。图7：的识别模型图8：的识别模型图9：的识别模型为配合机器人的连续模型，该识别模型用zero-orderhold方法从一个离散变量转换到一个连续变量，（26）（27）（28）4.2执行器的影响考虑执行器，其控制系统整体结构显示如图10，图10：闭环控制系统包括执行器其中是机器人速度向量关于自身坐标系统的命令。由于执行器动力（26）和（27）的两极具有负实部，因而这两个系统稳定。这意味着存在一个极短的时间，之后，真正的速度和收敛于理想的和，此时输入开始生效。因此，上述路径跟踪法也能保证机器人跟踪预期路径，即使在时间内的偏移距离与角误差可能增加。在定位跟踪控制中，动力系统（28）增加了一个两极闭环系统，如图11，控制器参数决定在上述部分可能导致系统失去稳定性。图11：机器人定位的闭环控制包括执行器的动态。通过核心技术设置闭环系统的极点和零点的位置，我们得到在条件满足下可以保证系统的稳定性，即使在执行器饱和的情况下。图12显示了一条在危急情况下开环系统的根轨迹，无论是任何正值，所有系统的闭环极点均位于左半平面。否则，当时，根轨迹可以穿越虚轴，当时闭环系统的极点可移动到右半平面。图12：开环模型的根轨迹5.实验我们的机器人实验室有一半以上的RoboCup中型组机器人，以上讨论的控制算法将在这里被测试。全方位机器人的应用显示在图13。图13：真正的全向机器人一个分辨率为的AVTMarlinF-046C彩色相机被装配了一个指向走向的双曲面镜，该双面曲镜安装在全向机器人的顶部，这样一个完整的环绕地图就被机器人捕获了。一个基于50赫兹输出信号的相机的自主定位算法描述如何得到机器人在某运行场地某时刻的位置。这个车轮能驱动三个的MaxonDC电机且车轮的最高速度是。三轮编码器用来测量车轮的实际速度，编码器通过三个控制器控制运转。一个八字形路径可作为参考路径，其几何对称性和曲率的急剧变化给测试带来了挑战。一个被选择的八字形路径和一个规模变量可表示为（29）机器人受控于沿着八字形路径以恒定速度，和我们的控制算法被选择的参数分别是。第一次实验所选路径的切线方向是预期的机器人定位。图14，15，16和17告诉我们所提出控制方法控制机器人的中心收敛于给定的路径和机器人定位跟踪一个可接受的理想的错误，此时执行机构的饱和度没有出现。为了检查在执行器饱和方面的影响，实验二选择了理想的机器人定位（30）其中是曲率路径在点P的曲率，其原因如图18，19，20和21告诉我们，机器人的中心收敛于给定的路径，即使当道路急转弯时车轮速度达到饱和状态。图14：参考路径和机器人路径。图15：距离误差。图16：定位误差。图17：真正的车轮速度。图18：参考路径和机器人路径。图19：距离误差。图20：定位误差。图21：真正的车轮速度。6.结论本文提出了一种全向机器人的新的运动控制方法。这种方法是基于逆输入输出线性化的机器人运动学模型，它完全分解了机器人平移和旋转。机器的平移受控于沿着参考路径行进，机器人的旋转受控于跟踪期望的定位。由于执行器的动态和饱和度极大地影响了机器人的性能，而避免这些影响的方法是控制器的设计时综合考虑这些方面的影响。根据Lyapunov稳定性理论，路径跟踪控制律的整体稳定性已经得到证实。根轨迹方法是用来分析和选择合适的控制器的参数，使得机器人的定位可以收敛到一个期望的方向甚至是当车轮速度饱和时。在现实世界的实验中，机器人受控于沿着一个八字形曲线、以一个恒定的的平移速度行进，并精确追踪改变定位。结果表明，所提出的控制方法在执行器的饱和与非饱和的情况下是有效的。7.参考文献[1]Campion,G.Bastin,G,D’Andréa-Novel,B.轮式移动机器人的运动学和动态模型的分类和结构性能[J].机器人与自动化的IEEE会刊，1996，12：47-62．[2]Heinemann,P,Rueckstiess,T,Zell,A.快速、准确的环境模块化在全方位系统上的动态认知的引入[D].2004.[3]Indiveri,G.,Paulus,J.,andPl¨oger,P.G.瑞典轮式移动机器人在存在执行器饱