[发明专利]一种控制补偿的最优轨迹规划方法、设备及存储设备

说明书

本发明公开了一种控制补偿的最优轨迹规划方法、设备及存储设备，该方法根据上位机输入的信息生成最优运动轨迹后，在考虑控制器接收离散控制信号造成的误差前提下，生成最优轨迹对应的控制补偿信息。本发明的有益效果是：上述过程提高了机器人控制的实时性和轨迹跟踪精度，同时该方法加入了一种轨迹空间转换工具，提高了不满足Pieper准则的机器人的逆运动学求解效率，进一步提高了轨迹规划的实时性。

技术领域

本发明涉及机器人轨迹规划领域，尤其涉及一种控制补偿的最优轨迹规划方法、设备及存储设备。

背景技术

轨迹规划是根据作业实际要求，设计各关节速度与加速度，使被控系统在规定时间内到达特定目标状态。轨迹规划可细分为基本轨迹规划和最优轨迹规划，其中基本轨迹规划只考虑被控系统的运动学特性，用于对运动的复现；最优轨迹规划是在基本轨迹规划基础上进一步考虑动力学特性，将轨迹规划问题转化为有约束的非线性规划问题的形式进行求解。

基本轨迹规划又可分为笛卡尔空间规划和关节空间规划，笛卡尔空间规划在目标系统的工作坐标系中进行，以末端执行器的轨迹曲线为规划目标，轨迹结果较为直观且能对规划动态进行实时观察，适用于连续路径规划作业。由于被控系统运动是直接控制各个关节，因此关节空间轨迹规划具有计算量小、实时性高和操作简便等优点，且能有效避免系统的奇异位置，一般用于点到点的运动作业中。上述轨迹规划方法操作简单可靠，规划结果是一个满足约束的可行解，但未对规划结果的最优性进行探讨；同时，由于基本轨迹规划只考虑运动学特性，尚未考虑动力学特性，因此大多适用于码垛、搬运等对速度和精度要求都不高的场合。

为了满足机器人复杂工况下对鲁棒性、灵敏度、精度等的更高要求，考虑动力学特性的最优轨迹规划成为促进机器人高性能运动的发展的关键技术。在建立有约束的非线性规划问题时，最优轨迹规划将工作效率、运动平稳性和能量消耗等性能问题考虑在内，因此最优轨迹规划方案在严格按照要求完成作业任务的同时，还能做到高效、低冲击、小磨损和低能耗。虽然最优轨迹规划具有诸多优点，但缺乏控制变量作为补偿输入控制器，机器人控制的实时性和轨迹跟踪精度会相对不足。

除此之外，轨迹规划都会涉及到轨迹点从笛卡尔空间到关节空间的转换，即逆运动学问题。当机器人满足Pieper准则时，即后三个关节轴线始终交于一点时，可采用封闭解法快速求解逆运动学问题。对于不满足Pieper准则的一般机器人，不存在封闭解，需要通过数值迭代方法求解逆运动学问题。但数值迭代方法求解逆运动学问题效率低，实时性差。由此可知，提高逆运动学问题求解效率是提升最优轨迹规划方法实时性的有效手段。

发明内容

为了改善上述最优轨迹规划方法存在的缺乏控制补偿的问题，以及降低一般机器人逆运动学求解效率对轨迹规划实时性的影响，本发明提供了一种控制补偿的最优轨迹规划方法，该方法根据上位机输入的信息生成最优运动轨迹后，在考虑控制器接收离散控制信号造成的误差前提下，生成最优轨迹对应的控制补偿信息。

本发明提供的一种控制补偿的最优轨迹规划方法，包括两个过程，分别为：轨迹规划过程和控制补偿过程；

所述轨迹规划过程包括以下步骤：

S101：获取上位机输入的目标权重和轨迹点；

S102：利用轨迹空间转换工具将所述轨迹点转换为机器人关节空间轨迹；

S103：根据所述目标权重和所述机器人关节空间轨迹，利用最优轨迹求解器，求解机器人最优轨迹；

所述控制补偿过程包括以下步骤：

S104：利用离散初始化工具将所述最优轨迹离散化，得到机器人离散控制补偿信息初始值；

S105：根据所述机器人离散控制补偿信息初始值，利用误差优化求解器求解得到优化后的控制补偿信息；