专利名称：一种移动机械臂分散集中自主切换控制方法
技术领域：
本发明属于机器人控制技术领域，具体涉及一种基于移动机械臂的分散-集中自主切换控制方法。
背景技术：
自二十世纪机械臂问世以来，机械臂得到了快速发展，并广泛用在了军事、工业和医疗等方面。随着各方面技术的进步，传统机械臂工作空间有限的缺点日益突出，使其已经无法满足各种较高的科技需求。由于移动机械臂拥有几乎无限大的工作空间和高度的运动冗余性，使得近几年来对于移动机械臂的研究成为了机器人领域中的热点。然而，又由于机械臂与可移动平台之间具有不同的动力学特性并存在强耦合问题，因此，移动机械臂的研究也是机器人领域中研究的难点问题之一。移动机械臂由一个可移动平台和一个或多个机械臂组成，这一结构使得移动机械臂既具有可移动平台的移动性，又具有了机械臂的可操作性。目前，针对移动机械臂的研究主要分为两个方向:一是对可移动平台和机械臂两个子系统的分散控制研究；二是对可移动平台和机械臂作为一个整体集中控制。由于对于移动机械臂的集中控制研究难度较大，存在动力学强耦合、运动学冗余、非完整约束限制等问题，因此，目前针对移动机械臂的研究大多停留在分散控制的研究(于振中，闻继宏，赵杰，陈志峰.9D0F全方位移动机械臂运动学及其控制系统研究.高技术通讯，2011年第21卷第I期)。分散控制是指将可移动平台和机械臂看作两个独立的子系统，忽略系统的动力学耦合，分别设计控制器来实现对两个子系统的控制。这种分散控制思想在国内外已经相对成熟，但是受其精度的影响，应用范围大打折扣。针对移动机械臂分散控制所存在的不足，移动机械臂的集中控制思想应运而生(谭湘敏，赵冬斌，易建强，徐冬.全方位移动机械手运动控制I一建模与控制水.机械工程学报，2009年第45卷第I 期)。它是将可移动平台和机械臂进行了整合，因此，它既拥有了可移动性，有拥有了可操作性。但是，在面对一个简单的任务时，这种集中控制所具有运动学冗余缺陷暴露出来，使得在完成任务时所付出的代价过大。综上所述，现有针对移动机械臂的研究仍有以下问题:针对可移动平台和机械臂两个子系统之间存在的强耦合、运动学冗余等问题还有待进一步的研究；在面对复杂度不同的任务时，不能合适的选取分散控制还是集中控制，同时控制精度和实时性等性能指标也得不到保证。因此，对于移动机械臂在其工作性能及两个子系统自主切换并协调的控制这两个方面还具有很高的研究价值。
发明内容
本发明要解决的技术问题是:针对现有技术中所存在的上述问题，提出一种移动机械臂分散集中自主切换控制方法，该方法能够针对不同的控制任务，在分散、集中控制之间选择一个合理的控制方案，保证在可移动平台和机械臂之间协调控制并保证任务的顺利完成，能够提高在未知外扰、环境时变、避障等不确定性因素影响下，移动机械臂的控制性倉泛。为了解决上述技术问题，本发明的技术方案为:一种移动机械臂分散集中自主切换控制方法，其特征在于主要包括以下步骤:A:对移动机械臂建立世界坐标系和车载坐标系，获取移动机械臂的当前位姿；移动机械臂的当前位姿是依靠平台上的传感装置和建立的坐标系确定的；世界坐标系用于确定移动机械臂在世界坐标中的位置；车载坐标系用于确定移动机械臂在行进过程中由传感器测量出的物体相对于移动机械臂的位置；B:由A步骤获取的移动机械臂的当前位姿，分别搭建分散控制模式和集中控制模式下移动机械臂的运动学模型和动力学模型，并根据搭建的运动学模型和动力学模型进行轨迹规划；当采用分散控制模式时，对机械臂和可移动平台分别进行控制，包括对可移动平台的路径规划，并利用D-H方法对机械臂建立运动学模型，进而对机械臂进行轨迹规划；当采用集中控制模式时，首先通过对机械结构和运动特性的分析，建立整体系统的运动学模型，然后利用拉格朗日力学法建立动力学模型，并在此模型基础上对机械臂和可移动平台进行协调控制，最后，采用人工势函数方法驱使移动机械臂系统完成运动规划任务；C:设计出分散集中自主切换控制器并根据分散集中自主切换控制器目标函数取值决定是否进行控制模式切换，如给定的任务比较复杂，利用分散集中自主切换控制器，实现在分散控制模式和集中控制模式之间的切换，之后以切换后的控制模式对移动机械臂进行控制，并驱动移动机械臂运动，最终完成既定任务；如给定的任务比较简单，不需要通过分散集中自主切换控制器切换控制模式来实现，则按B步骤原定的分散控制模式或集中控制模式继续对移动机械臂进行控制，最终完成既定任务。按上述技术方案，C步骤中所述的分散集中控制自主切换控制器是以数据测试的方法对已获得的外部提取信息值进行反馈、修正和优化，同时以机械臂辅助状态变量xa，动力学变量I a，机械臂末端执行器约束函数ca，建立分散控制优化模型为fa(X)=fa(Xa, ξ a, Ca);以移动平台辅助状态变量X。，协同控制设计变量ξ。，移动平台约束函数C。，建立集中控制优化模型为fc (X) =fc (X。，ξ。，C。)；然后，利用可变优先级与包容式结构算法，建立分散集中控制多目标优化函数:minf⑴=min [fa⑴，f。⑴]，根据分散集中控制多目标优化函数取值来决定是否进行控制模式的切换。按上述技术方案，C步骤中，如之前的B步骤中为分散控制模式，则在分散集中控制多目标优化函数minf (X)取值为fa(X)时，保持原分散控制模式，在minf (X)取值为fc (X)时，切换到集中控制模式。按上述技术方案，B步骤采用当采用集中控制模式时所涉及的协调控制为:利用移动机械臂和可移动平台的动力学系统的界函数构造滑模控制器，通过滑模控制器将一个给定的任务分解成机械臂的操作和移动平台的移动，从而实现对移动机械臂的动作控制。按上述技术方 案，B步骤中，分散控制模式是把机械臂和可移动平台当作两个子系统，分别加以控制；当采用分散控制模式时，如果给定任务的涉及空间范围在机械臂所能到达的空间范围内，则可移动平台不动，仅对机械臂进行相应的轨迹规划，即首先对机械臂建立坐标系，建立相应的关节和连杆参数表，根据D-H法求出各连杆坐标系之间的齐次变换矩阵，由此得出机械臂的运动学方程，进而对机械臂进行轨迹规划；如果给定任务的涉及空间范围在机械臂所能到达的空间范围以外，则首先需对可移动平台进行路径规划，到达相应的空间之后，再对机械臂进行轨迹规划。相对于现有技术，本发明的有益效果如下:本发明针对任务的多样性和复杂性，设计出分散集中自主切换控制器，能够合理地选择分散或集中控制策略来完成任务，并能针对复杂任务在任务执行过程中自主切换分散、集中控制模式来高效率的完成任务，不仅保证了机械臂与可移动平台之间的协调控制和系统的控制性能，并整合了分散、集中控制两方面的优点，即系统的稳定性、控制精度高和实时性、操作能力强等。提高了移动机械臂在未知外扰、环境时变、避障等不确定性因素影响下的控制性能。本发明可广泛用于工业生产，医疗辅助等应用领域，还可拓展针对水下机器人、飞行机器人等不同对象的研究。
图1是本发明的移动机械臂分散集中自主切换控制方法流程框图。图2是本发明中的移动机械臂结构示意图。
具体实施例方式下面结合附图和具体实施例对本发明作进一步的描述。根据本发明实施的移动机械臂分散集中自主切换控制方法如图1所示，主要包括以下步骤:A:对移动机械臂建立世界坐标系和车载坐标系，获取移动机械臂的当前位姿；移动机械臂的当前位姿是依靠平台上的传感装置和建立的坐标系确定的；世界坐标系用于确定移动机械臂在世界坐标中的位置；车载坐标系用于确定移动机械臂在行进过程中由传感器测量出的物体相对于移动机械臂的位置。对移动机械臂建立的世界坐标系和车载坐标系如图2所示。在这里，我们假设机械臂I为二连杆机械臂ABC，可移动平台2为差分驱动两轮轮式机器人，因此，该系统为由非完整移动基和完整机械臂构成的移动机械臂系统。如图1所示，设机械臂I与可移动平台2
连接点为可移动平台2的质心，移动机械臂的当前位姿g = yc φ θχ幻，其中为
可移动平台2相对于X正轴的方向，01和θ2分别为机械臂I两个关节转动的角度；X。和Yc分别为质心C在XY平面上坐标。B:由A步获取的移动机械臂的当前位姿，分别搭建分散控制模式和集中控制模式下移动机械臂的运动学模型和动力学模型，并根据搭建的运动学模型和动力学模型进行轨迹规划。当采用分散控制模式时，对机械臂和可移动平台分别进行控制，包括对可移动平台的路径规划，并利用D-H方法对机械臂建立运动学模型，进而对机械臂进行轨迹规划；当采用集中控制模式时，首先通过对机械结构和运动特性的分析，建立整体系统的运动学模型，然后利用拉格朗日力学法建立动力学模型，并在此模型基础上对机械臂和可移动平台加以协调控制，最后，采用人工势函数方法驱使移动机械臂系统完成其运动规划任务。按上述技术方案，B步骤中，分散控制模式是把机械臂和可移动平台当作两个子系统，分别加以控制；当采用分散控制模式时，如果给定任务的涉及空间范围在机械臂所能到达的空间范围内，则可移动平台不动，仅对机械臂进行相应的轨迹规划，即首先对机械臂建立坐标系，建立相应的关节和连杆参数表，根据D-H法求出各连杆坐标系之间的齐次变换矩阵，由此得出机械臂的运动学方程，进而对机械臂进行轨迹规划；如果给定任务的涉及空间范围在机械臂所能到达的空间范围以外，则首先需对可移动平台进行路径规划，到达相应的空间之后，再对机械臂进行轨迹规划。按上述技术方案，B步骤中，集中控制模式是把机械臂和可移动平台当作一个整体，对这一整体进行集中分析和控制；当采用集中控制时，根据拉格朗日方程和罗兹动力学方程得到移动机械臂整体系统的运动学和动力学模甩:q = S(q)z(I)
权利要求
1.一种移动机械臂分散集中自主切换控制方法，其特征在于主要包括以下步骤: A:对移动机械臂建立世界坐标系和车载坐标系，获取移动机械臂的当前位姿；移动机械臂的当前位姿是依靠平台上的传感装置和建立的坐标系确定的；世界坐标系用于确定移动机械臂在世界坐标中的位置；车载坐标系用于确定移动机械臂在行进过程中由传感器测量出的物体相对于移动机械臂的位置； B:由A步骤获取的移动机械臂的当前位姿，分别搭建分散控制模式和集中控制模式下移动机械臂的运动学模型和动力学模型，并根据搭建的运动学模型和动力学模型进行轨迹规划； 当采用分散控制模式时，对机械臂和可移动平台分别进行控制，包括对可移动平台的路径规划，并利用D-H方法对机械臂建立运动学模型，进而对机械臂进行轨迹规划；当采用集中控制模式时，首先通过对机械结构和运动特性的分析，建立整体系统的运动学模型，然后利用拉格朗日力学法建立动力学模型，并在此模型基础上对机械臂和可移动平台进行协调控制，最后，采用人工势函数方法驱使移动机械臂系统完成运动规划任务； C:设计出分散集中自主切换控制器并根据分散集中自主切换控制器目标函数取值决定是否进行控制模式切换，如给定的任务比较复杂，利用分散集中自主切换控制器，实现在分散控制模式和集中控制模式之间的切换，之后以切换后的控制模式对移动机械臂进行控制，并驱动移动机械臂运动，最终完成既定任务；如给定的任务比较简单，不需要通过分散集中自主切换控制器切换控制模式来实现，则按B步骤原定的分散控制模式或集中控制模式继续对移动机械臂进行控制，最终完成既定任务。
2.根据权利要求1所述的自主切换控制方法，其特征在于:C步骤中所述的分散集中控制自主切换控制器是以数据测试的方法对已获得的外部提取信息值进行反馈、修正和优化，同时以机械臂辅助状态变量Xa，动力学变量ξ a，机械臂末端执行器约束函数Ca，建立分散控制优化模型为fJX)=fa(Xa，ξ a, Ca);以移动平台辅助状态变量X。，协同控制设计变量I。，移动平台约束函数C。，建立集中控制优化模型为 ；(Χ)= ；(Χ。，ξ。，C。)； 然后，利用可变优先级与包容式结构算法，建立分散集中控制多目标优化函数:minf⑴=min [fa⑴，f。⑴]，根据分散集中控制多目标优化函数取值来决定是否进行控制模式的切换。
3.根据权利要求2所述的自主切换控制方法，其特征在于:C步骤中，如之前的B步骤中为分散控制模式，则在分散集中控制多目标优化函数minf (X)取值为fa(X)时，保持原分散控制模式，在minf (X)取值为f；(X)时，切换到集中控制模式。
4.根据权利要求1-3之一所述的自主切换控制方法，其特征在于:B步骤采用当采用集中控制模式时所涉及的协调控制为:利用移动机械臂和可移动平台的动力学系统的界函数构造滑模控制器，通过滑模控制器将一个给定的任务分解成机械臂的操作和移动平台的移动，从而实现对移动机械臂的动作控制。
5.根据权利要求1-3之一所述的自主切换控制方法，其特征在于:B步骤中，分散控制模式是把机械臂和可移动平台当作两个子系统，分别加以控制；当采用分散控制模式时，如果给定任务的涉及空间范围在机械臂所能到达的空间范围内，则可移动平台不动，仅对机械臂进行相应的 轨迹规划，即首先对机械臂建立坐标系，建立相应的关节和连杆参数表，根据D-H法求出各连杆坐标系之间的齐次变换矩阵，由此得出机械臂的运动学方程，进而对机械臂进行轨迹规划；如果给定任务的涉及空间范围在机械臂所能到达的空间范围以外，则首先需对 可移动平台进行路径规划，到达相应的空间之后，再对机械臂进行轨迹规划。
全文摘要
本发明涉及一种移动机械臂分散集中自主切换控制方法，首先对移动机械臂建立世界坐标系和车载坐标系，获取移动机械臂的当前位姿，然后针对不同的控制策略对系统建立运动学和动力学模型，并设计分散集中控制自主切换器，通过对移动机械臂和可移动平台的协调控制，最终完成既定任务。该方法解决了针对不同的控制任务，在分散、集中控制之间选择一个合理的控制方案，保证在可移动平台和机械臂之间协调控制下任务的顺利完成，进而提高在未知外扰、环境时变、避障等不确定性因素影响下，移动机械臂的控制性能。本发明可广泛用于工业生产，医疗辅助等应用领域，还可拓展针对水下机器人、飞行机器人等不同对象的研究。
文档编号B25J9/16GK103240739SQ20131016458
公开日2013年8月14日 申请日期2013年5月7日 优先权日2013年5月7日
发明者吴怀宇, 陈雪锋, 韩涛, 吴若鸿, 钟锐, 张志芬, 林冠西 申请人:武汉科技大学