一种并联机械臂的运动规划与控制方法技术

本发明专利技术提供了一种并联机械臂的运动规划和控制方法，包括如下步骤：步骤一，规划并联机械臂末端执行器预期的运动轨迹；步骤二，根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式；步骤三，基于步骤一与步骤二构建误差函数并结合张动力学计算各驱动杆相应的长度变化率；步骤四，将步骤三的求解结果传递给下位机控制器驱动机械臂运动。本发明专利技术解决了传统方法中参数难以确定的问题，且能够有效控制末端执行器的轨迹，可操作性高，在工程领域中具有良好的应用前景。

【技术实现步骤摘要】

本专利技术涉及并联机械臂运动规划及控制领域，更具体的说是一种并联机械臂的运动规划与控制方法。
技术介绍
并联机械臂由动平台和静平台通过两个或两个以上分支并联而成，为多路闭环机构。并联机械臂因其具有精度高、惯性小、刚度大、承载能力高等特性，得到了业界的重视与研究，相继开发出了具有重大应用价值Stewart并联机械臂与Delta并联机械臂等，而对并联机械臂的运动规划与控制则是工业应用中十分重要的研究内容之一。目前并联机械臂的运动规划与控制方法通常采用PID法。PID法是最为广泛应用的控制方法，由于设计简单可行，应用十分广泛。但不足的是，PID法三个参数的调整是一直以来未能得到有效解决的难题，这三个参数的设置往往会消耗操作人员大量的时间，降低办事的效率。
技术实现思路
本专利技术所要解决的技术问题是克服现有技术的不足，提供一种设计简单、易于操作且能实现有效控制的并联机械臂的运动规划与控制方法。为解决现有技术问题，本专利技术采用的技术方案是：一种并联机械臂的运动规划与控制方法，包括如下步骤：步骤一，规划并联机械臂末端执行器预期的运动轨迹；步骤二，根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式；步骤三，基于步骤一与步骤二构建误差函数并结合张动力学计算各驱动杆相应的长度变化率；步骤四，将步骤三的求解结果传递给下位机控制器驱动机械臂运动。本专利技术通过设置四个步骤来控制机械臂运动，整个过程简单且易于操作，避免了以往操作复杂且难以控制的情形。所述步骤一中规划并联机械臂末端执行器预期的运动轨迹包括设定末端执行器的期望位姿rd与期望位姿变化率通过末端执行器的期望位姿rd与期望位姿变化率也即可以确定并联机械臂末端执行器预期的运动轨迹。所述步骤二中根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式，所述关系式为其中为各驱动杆的长度变化率，为末端执行器的位姿变化率，f(·)为并联机械臂由笛卡尔空间到关节空间的非线性映射函数。通过该关系式，将各驱动杆的长度变化率和末端执行器的位姿变化率联系起来，利用末端执行器的位姿变化率就可以计算得到各驱动杆的长度变化率。进一步的，所述步骤三基于步骤一与步骤二所得的末端执行器的期望位姿rd、期望位姿变化率和并联机械臂速度层运动学关系式构建误差函数e＝r-rd，其中r为末端执行器的实际位姿；结合张动力学，即令其中λ为正实数，作为收敛因子用于控制该法的收敛速度，计算得到各驱动杆相应的长度变化率对应地，各驱动杆相应的长度变化率在计算机数字离散控制系统中为u·(kτ)=f(r·d(kτ)-λ(r(kτ)-rd(kτ))),]]>其中kτ为离散时刻，τ为控制采样间隔。这样，只需要确定参数λ，就可以得到各驱动杆相应的长度变化率。进一步的，通过步骤四将步骤三的求解结果传递给下位机控制器驱动机械臂运动，由于各驱动杆相应的长度变化对应着机械臂不同的运动，从而实现对机械臂运动的控制。与现有技术相比，本专利技术的方法设计简单，张动力学的引入可以保证误差函数的收敛，确保控制的高精度，而且该方法只有一个参数λ需要确定，易于操作，有效避免了传统方法参数较多难以控制的情形，在实际应用中有重要作用和广阔前景。附图说明图1为本专利技术实施例的流程图。图2为本专利技术实施例的仿真Stewart并联机械臂的模型图。图3为本专利技术实施例的仿真Stewart并联机械臂的目标轨迹与实际轨迹图。图4为本专利技术实施例的仿真Stewart并联机械臂的轨迹误差图。图5为本专利技术实施例的仿真Stewart并联机械臂的驱动杆长度变化图。具体实施方式以下结合附图对本专利技术做进一步的解释说明。附图仅用于示例性说明，不能理解为对本专利技术的限制；为了更好说明本实施例，附图某些部件会有省略、放大或缩小；对于本领域技术人员来说，附图中某些公知结构及其说明可能省略是可以理解的。如图1所示的一种并联机械臂运动规划与控制方法，包括：步骤一，规划并联机械臂末端执行器预期的运动轨迹，其中包括末设定端执行器的期望位姿rd与期望位姿变化率步骤二，根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式其中为各驱动杆的长度变化率，为末端执行器的位姿变化率，f(·)为并联机械臂由笛卡尔空间到关节空间的非线性映射函数；步骤三，基于步骤一与步骤二构建误差函数并结合张动力学计算各驱动杆相应的长度变化率，构建误差函数e＝r-rd，其中r为末端执行器的实际位姿，并结合张动力学，即令其中λ为收敛因子用于控制该法的收敛速度，便可计算得到各驱动杆相应的长度变化率对应地，各驱动杆相应的长度变化率在计算机数字离散控制系统中为其中kτ为离散时刻，τ为控制采样间隔，这样，只需要确定参数λ，就可以得到各驱动杆相应的长度变化率；步骤四，将步骤三的求解结果传递给下位机控制器驱动机械臂运动。如图2所示，该机械臂由静平台(FP)、动平台(MP)、末端执行器和六根驱动杆(L1，L2，L3，L4，L5，L6)组成(在不特别说明的情况下，所有的坐标表示都是基于静平台坐标系)。该并联机械臂速度层运动学关系式为其中代表位置的变化率，代表姿态的变化率，A具体为：其中，为各驱动杆末端指向首端的向量，且i＝1,2,...,6。末端为驱动杆与静平台的连接点，首端为驱动杆与动平台的连接点。为各驱动杆的长度，且有||di||2＝ui，||·||2表示2范数。为末端执行器相对于静平台坐标系的旋转矩阵。为驱动杆首端相对于动平台坐标系的位置。并且A可分为两个矩阵，具体为A＝[A1A2]，其中A1与末端执行器的位置相关，而A2与末端执行器的姿态相关。基于一种并联机械臂运动规划和控制方法，给定末端执行器任务为画出一个空间中的无穷大符号。不考虑末端执行器的姿态，规划并联机械臂的运动：设定并联机械臂的初始位姿为rd(0)＝[0,0,1]T，期望位姿变化率为：r·d=vxvyvz=-0.75πsin(5πt3)0.6495πcos(10πt3)0.375πcos(10πt3)]]>由于不考虑末端执行器的姿态，该并联机械臂速度层运动学关系式可简化为基于一种并联机械臂运动规划和控制方法，把收敛因子λ的值设为1000，便可计算并得到仿真Stewart并联机械臂各驱动杆相应的长度变化率为u·=A1r·p=A1(r·d-λ(r-rd))本文档来自技高网...

【技术保护点】
一种并联机械臂的运动规划与控制方法，其特征在于，包括以下步骤：步骤一，规划并联机械臂末端执行器预期的运动轨迹；步骤二，根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式；步骤三，基于步骤一与步骤二构建误差函数并结合张动力学计算各驱动杆相应的长度变化率；步骤四，将步骤三的求解结果传递给下位机控制器驱动机械臂运动。

【技术特征摘要】
1.一种并联机械臂的运动规划与控制方法，其特征在于，包括以下步骤：
步骤一，规划并联机械臂末端执行器预期的运动轨迹；
步骤二，根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式；
步骤三，基于步骤一与步骤二构建误差函数并结合张动力学计算各驱动杆相应的长度
变化率；
步骤四，将步骤三的求解结果传递给下位机控制器驱动机械臂运动。
2.根据权利要求1所述的并联机械臂的运动规划与控制方法，其特征在于，所述步骤一
中规划并联机械臂末端执行器预期的运动轨迹包括设定末端执行器的期望位姿rd与期望
位姿变化率3.根据权利要求1所述的并联机械臂的运动规划与控制方法，其特征在于，所述步骤二
中根据具体的并联机械臂参数计算相应的并联机械臂速度层运动学关系式，所述关系式为
其中为各驱动杆的长度变化率，为末端执行...

【专利技术属性】
技术研发人员：张雨浓，何良宇，李帅，丁亚琼，陈德潮，
申请(专利权)人：中山大学，
类型：发明
国别省市：广东;44