一种机器人单关节位置控制方法与流程

1.本发明涉及工业机器人技术领域，特别涉及一种机器人单关节位置控制方法。


背景技术：

2.随着工业机器人应用领域的不断扩大以及现代工业的快速发展，人们对工业机器人性能的要求越来越高，以进一步提高生产效率和产品质量，因此高速、高精度成为目前机器人控制的发展趋势。
3.但是目前机器人控制还面临着一些重要挑战，因为机器人是一个强非线性，强时变性，强耦合系统，且在系统建模过程中有很多的不确定性，如外部扰动，系统参数的建立和变化等。
4.目前机器人主要采用单关节伺服传统三环pi控制方法。该方法是目前使用最普遍的控制方法，无需控制模型，通过纠正偏差达到指令目标。但是由于机器人单关节的柔性，会产生很大的位置误差和力矩误差，期望外的过度过程，甚至影响系统的稳定性。所以机器人单关节的高速度高精度仍然是现代机器人控制面临的挑战。


技术实现要素：

5.本发明的目的旨在至少解决所述技术缺陷之一。
6.为此，本发明的目的在于提出一种机器人单关节位置控制方法。
7.为了实现上述目的，本发明的实施例提供一种机器人单关节位置控制方法，包括如下步骤：步骤s1，建立机器人单关节动力学系统；其中，所述机器人单关节动力学系统模型如下：如下：其中：：连杆端角度；：电机端角度； : 连杆端惯量；：连杆端科氏力项；：连杆刚度；：电机端惯量；：电机端阻尼；：电机端出力；步骤s2，根据单关节运动建模定义x的函数、目标电机端位置的函数；步骤s3，定义一个李雅普诺夫函数，其中，，其中，
：为负定义的函数；：非负常数，用来表示系统的不确定性；xd : 笛卡尔空间位置指令；qd : 连杆端目标位置；ex : 笛卡尔空间位置误差；e1 : 连杆端位置误差；e2 : 连杆端速度误差；步骤s4，定义目标电机速度的函数；步骤s5，根据上述参数计算得到最终控制电机加速度的控制量。
8.进一步，在所述步骤s2中，所述根据单关节运动建模定义的函数，及目标电机端位置的函数，包括：的函数，包括：；f : 笛卡尔空间速度的运动学模型，通过单关节的位置时间和结构特性建立的函数；g : 目标位置的运动学模型，通过单关节的位置时间和结构特性建立的函数；t : 时间变量。
9.进一步，在所述步骤s4中，所述定义目标电机速度的函数，包括：；其中：；；：可调参数，调整电机位置收敛速度的正数。
10.进一步，在所述步骤s4中，所述计算得到最终控制电机加速度的控制量，包括：其中，
ꢀꢀ
：可调参数，调整电机速度收敛速度的正数。
11.根据本发明实施例的机器人单关节位置控制方法，通过机器人加入电机端目标速度控制的单关节位置控制策略，考虑关节刚度，用以提升控制精度。通过单关节动力学控制单关节连杆的加速度，来精确控制位置。本发明通过对单关节建模，提高了单关节位置的控制精度。本发明设计应用于机器人单关节的位置控制。 通过李雅普诺夫函数和电机目标速度控制的加入提高系统的控制精度和稳定性。综合后显著提高了系统的精度和稳定性。
12.本发明附加的方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本发明的实践了解到。
附图说明
13.本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得
明显和容易理解，其中：图1为根据本发明实施例的机器人单关节位置控制方法的流程图。
具体实施方式
14.下面详细描述本发明的实施例，所述实施例的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的，旨在用于解释本发明，而不能理解为对本发明的限制。
15.如图1所示，本发明实施例的机器人单关节位置控制方法，包括如下步骤：步骤s1，建立机器人单关节动力学系统；其中，机器人单关节动力学系统模型如下：下：其中：：连杆端角度；：电机端角度； : 连杆端惯量；：连杆端科氏力项；：连杆刚度；：电机端惯量；：电机端阻尼；：电机端出力。
16.步骤s2，根据单关节运动建模定义x的函数、目标电机端位置的函数。
17.具体的，根据单关节运动建模定义的函数，及目标电机端位置的函数，包括：的函数，包括：。
18.f : 笛卡尔空间速度的运动学模型，通过单关节的位置时间和结构特性建立的函数；g : 目标位置的运动学模型，通过单关节的位置时间和结构特性建立的函数；t : 时间变量。
19.步骤s3，定义一个李雅普诺夫函数，其中，，其中，，其中，，其中，，其中，：为负定义的函数；：非负常数，用来表示系统的不确定性；xd : 笛卡尔空间位置指令；qd : 连杆端目标位置；ex : 笛卡尔空间位置误差；e1 : 连杆端位置误差；e2 : 连杆端速度误差。
20.步骤s4，定义目标电机速度的函数。
21.具体的，定义目标电机速度的函数，包括：；其中：；；：可调参数，调整电机位置收敛速度的正数。
22.步骤s5，根据上述参数计算得到最终控制电机加速度的控制量。
23.具体的，计算得到最终控制电机加速度的控制量，包括：其中， ：可调参数，调整电机速度收敛速度的正数。
24.根据本发明实施例的机器人单关节位置控制方法，通过机器人加入电机端目标速度控制的单关节位置控制策略，考虑关节刚度，用以提升控制精度。通过单关节动力学控制单关节连杆的加速度，来精确控制位置。本发明通过对单关节建模，提高了单关节位置的控制精度。本发明设计应用于机器人单关节的位置控制。 通过李雅普诺夫函数和电机目标速度控制的加入提高系统的控制精度和稳定性。综合后显著提高了系统的精度和稳定性。
25.在本说明书的描述中，参考术语“一个实施例”、“一些实施例”、
ꢀ“
示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不一定指的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
26.尽管上面已经示出和描述了本发明的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本发明的限制，本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。本发明的范围由所附权利要求及其等同限定。


技术特征：
1.一种机器人单关节位置控制方法，其特征在于，包括如下步骤：步骤s1，建立机器人单关节动力学系统；其中，所述机器人单关节动力学系统模型如下：下：其中：：连杆端角度；：电机端角度； : 连杆端惯量；：连杆端科氏力项；：连杆刚度；：电机端惯量；：电机端阻尼；：电机端出力；步骤s2，根据单关节运动建模定义x的函数、目标电机端位置的函数；步骤s3，定义一个李雅普诺夫函数，其中，，其中，，其中，，其中，，其中，：为负定义的函数；：非负常数，用来表示系统的不确定性；xd : 笛卡尔空间位置指令；qd : 连杆端目标位置；ex : 笛卡尔空间位置误差；e1 : 连杆端位置误差；e2 : 连杆端速度误差；步骤s4，定义目标电机速度的函数；步骤s5，根据上述参数计算得到最终控制电机加速度的控制量。2.如权利要求1所述的机器人单关节位置控制方法，其特征在于，在所述步骤s2中，所述根据单关节运动建模定义的函数，及目标电机端位置的函数，包括：的函数，包括：f : 笛卡尔空间速度的运动学模型，通过单关节的位置时间和结构特性建立的函数；g : 目标位置的运动学模型，通过单关节的位置时间和结构特性建立的函数；t : 时间变量。3.如权利要求1所述的机器人单关节位置控制方法，其特征在于，在所述步骤s4中，所述定义目标电机速度的函数，包括：；其中：；；：可调参数，调整电机位置收敛速度的正数。
4.如权利要求3所述的机器人单关节位置控制方法，其特征在于，在所述步骤s4中，所述计算得到最终控制电机加速度的控制量，包括：其中，
ꢀꢀ
：可调参数，调整电机速度收敛速度的正数。

技术总结
本发明提出了一种机器人单关节位置控制方法，包括：建立机器人单关节动力学系统；根据单关节运动建模定义x的函数、目标电机端位置的函数；定义一个李雅普诺夫函数；定义目标电机速度的函数；根据上述参数计算得到最终控制电机加速度的控制量。。。


技术研发人员：张靖棋 庹华 韩峰涛 于文进 杨春卫 姜鼎盛 刘长乐 张航
受保护的技术使用者：珞石（北京）科技有限公司
技术研发日：2022.07.26
技术公布日：2022/8/22