工业机器人的控制方法、装置、介质、控制器和程序产品与流程

摘要: 本发明涉及控制领域,尤其涉及一种工业机器人的控制方法、装置、介质、控制器和程序产品,属于工业机器人的控制。背景技术:1、随着自动化技术的发展,机器人的应用越来越...
工业机器人的控制方法、装置、介质、控制器和程序产品与流程

本发明涉及控制领域,尤其涉及一种工业机器人的控制方法、装置、介质、控制器和程序产品,属于工业机器人的控制。

背景技术:

1、随着自动化技术的发展,机器人的应用越来越广泛,机器人技术向轻量化、高速化、高精度发展过程中面临相关技术中的控制方法失效的问题。因机器人关节存在柔性,易出现相位滞后导致的稳定性不足和抖动问题,工业机器人的抖动抑制是保障运行精度的核心需求。

2、相关技术中,在工业控制和运动控制中,比例-积分-微分 (pid)控制及其变种算法由于其结构简单、易于工程实现,仍然是被最广泛采用的控制方法,但在面对现代高性能需求时,其劣势非常明显,抗干扰能力弱,必须等到扰动导致输出偏离设定值后,才开始调整控制量,难以抑制机器人运动中的抖动。

技术实现思路

1、本发明要解决的技术问题在于相关技术中的比例-积分-微分(pid)控制难以抑制机器人运动中的抖动,从而提供工业机器人的控制方法、装置、介质、控制器和程序产品,属于工业机器人的控制。

2、本发明一方面提供了一种工业机器人的控制方法,包括:接收工业机器人位置指令;根据接收到的所述位置指令对所述工业机器人进行运动规划,得到所述工业机器人的运动规划数据;根据进行运动规划得到的所述工业机器人的运动规划数据,对所述工业机器人进行控制;根据进行运动规划得到的所述工业机器人的运动规划数据,对预先配置的观测器进行配置;通过所述预先配置的观测器对所述工业机器人的外部扰动信号进行观测,生成扰动补偿信号;将生成的所述扰动补偿信号补偿到所述工业机器人的电机的输入端,以抑制所述工业机器人在运动过程中的抖动。

3、可选地,所述预先配置的观测器的表达式为:

4、

5、其中, 为电磁转矩,j为系统转动惯量,为转子机械角速度,为转子机械角速度的估计值, 为负载转矩的估计值,b为预设的摩擦系数,θm为机械角度,k为观测器的转矩输出增益参数。

6、可选地,通过所述预先配置的观测器对所述机器人的外部扰动信号进行观测,生成扰动补偿信号,包括:通过如下估计方程,对所述机器人的负载转矩进行观测,生成扰动补偿信号:

7、

8、其中,j为系统转动惯量,为转子机械角速度,为转子机械角速度的估计值,为负载转矩的估计值,即扰动补偿信号,k为观测器的增益参数。

9、可选地,根据进行运动规划得到的所述机器人的运动规划数据,对预先配置的观测器进行配置,包括:根据进行运动规划得到的所述机器人的运动规划数据,对所述观测器的转矩输出增益参数进行调整和限幅。

10、可选地,所述运动规划数据,包括:规划速度和规划加速度;根据进行运动规划得到的所述机器人的运动规划数据,对所述观测器的转矩输出增益参数进行调整和限幅,包括:根据进行运动规划得到的所述工业机器人运动的规划速度和规划加速度,按照如下整定公式对所述观测器的转矩输出增益参数进行调整和限幅:

11、

12、其中,为所述观测器的截止频率,j为控制系统转动惯量,为规划速度,为规划加速度,为电机额定扭矩,为设定系数。

13、可选地,所述设定系数的取值范围为1~3。

14、本发明另一方面提供了一种工业机器人的控制装置,包括:接收单元,用于接收工业机器人位置指令;规划单元,用于根据所述接收单元接收到的所述位置指令对所述工业机器人进行运动规划,得到所述工业机器人的运动规划数据;控制单元,用于根据所述规划单元进行运动规划得到的所述工业机器人的运动规划数据,对所述工业机器人进行控制;配置单元,用于根据所述规划单元进行运动规划得到的所述工业机器人的运动规划数据,对预先配置的观测器进行配置;生成单元,用于通过所述预先配置的观测器对所述工业机器人的外部扰动信号进行观测,生成扰动补偿信号;补偿单元,用于将所述生成单元生成的所述扰动补偿信号补偿到所述工业机器人的电机的输入端,以抑制所述工业机器人在运动过程中的抖动。

15、可选地,所述预先配置的观测器的表达式为:

16、

17、其中, 为电磁转矩,j为系统转动惯量,为转子机械角速度,为转子机械角速度的估计值,为负载转矩的估计值,b为预设的摩擦系数,θm为机械角度,k为观测器的转矩输出增益参数。

18、可选地,所述生成单元,通过所述预先配置的观测器对所述机器人的外部扰动信号进行观测,生成扰动补偿信号,包括:通过如下估计方程,对所述机器人的负载转矩进行观测,生成扰动补偿信号:

19、

20、其中,j为系统转动惯量,为转子机械角速度,为转子机械角速度的估计值,为负载转矩的估计值,即扰动补偿信号,k为观测器的增益参数。

21、可选地,所述配置单元,根据所述规划单元进行运动规划得到的所述机器人的运动规划数据,对预先配置的观测器进行配置,包括:根据进行运动规划得到的所述机器人的运动规划数据,对所述观测器的转矩输出增益参数进行调整和限幅。

22、可选地,所述运动规划数据,包括:规划速度和规划加速度;所述配置单元,根据进行运动规划得到的所述机器人运动的规划速度和规划加速度,对所述观测器的转矩输出增益参数进行调整和限幅,包括:根据进行运动规划得到的所述工业机器人运动的规划速度和规划加速度,按照如下整定公式对所述观测器的转矩输出增益参数进行调整和限幅:

23、

24、其中,为所述观测器的截止频率,j为控制系统转动惯量,为规划速度,为规划加速度,为电机额定扭矩,为设定系数。

25、可选地,所述设定系数的取值范围为1~3。

26、本发明又一方面提供了一种存储介质,其上存储有计算机程序,所述程序被处理器执行时实现前述任一所述方法的步骤。

27、本发明再一方面提供了一种工业机器人的控制器,包括处理器、存储器以及存储在存储器上可在处理器上运行的计算机程序,所述处理器执行所述程序时实现前述任一所述方法的步骤。

28、本发明再一方面提供了一种工业机器人的控制器,包括前述任一所述的工业机器人的控制装置。

29、本发明再一方面提供了一种计算机程序产品,包括计算机程序,所述计算机程序被处理器执行时实现前述任一所述方法的步骤。

30、根据本发明的技术方案,在机器人运行时,通过观测器即时估计系统中会造成机器人抖动的扰动信号并补偿,并根据运动规划数据对观测器进行配置,避免因参数不当导致引入新的扰动,导致末端抖动、超调甚至系统不稳定,属于工业机器人的控制。

31、根据本发明的技术方案,通过运动规划数据调整补偿信号幅值,避免因参数不当导致引入新的扰动,导致末端抖动、超调甚至系统不稳定,能够高效、低成本地解决了工业机器人抖动难以抑制的问题,同时不破坏机器人运行轨迹,增加工业机器人的鲁棒性。提升系统在模型不准确和外部扰动时的鲁棒性和动态控制性能。

1.一种工业机器人的控制方法,其特征在于,包括:

2.根据权利要求1所述的方法,其特征在于,所述预先配置的观测器的表达式为:

3.根据权利要求1所述的方法,其特征在于,通过所述预先配置的观测器对所述机器人的外部扰动信号进行观测,生成扰动补偿信号,包括:

4.根据权利要求3所述的方法,其特征在于,根据进行运动规划得到的所述机器人的运动规划数据,对预先配置的观测器进行配置,包括:

5.根据权利要求4所述的方法,其特征在于,所述运动规划数据,包括:规划速度和规划加速度;根据进行运动规划得到的所述机器人的运动规划数据,对所述观测器的转矩输出增益参数进行调整和限幅,包括:

6.根据权利要求5所述的方法,其特征在于,所述设定系数的取值范围为1~3。

7.一种工业机器人的控制装置,其特征在于,包括:

8.一种存储介质,其特征在于,其上存储有计算机程序,所述程序被处理器执行时实现权利要求1-6任一所述方法的步骤。

9.一种控制器,其特征在于,包括处理器、存储器以及存储在存储器上可在处理器上运行的计算机程序,所述处理器执行所述程序时实现权利要求1-6任一所述方法的步骤,或者包括如权利要求7所述的控制装置。

10.一种计算机程序产品,其特征在于,包括计算机程序,所述计算机程序被处理器执行时实现权利要求1-6任一所述方法的步骤。