CN110587611A - 电视机组装线的机械臂控制方法 - Google Patents

Abstract

本发明为电视机组装线的机械臂控制方法，提供了一种机器人机械臂的高效控制方法，通过计算机器人机械臂控制中所涉及到的能源消耗，同时建立机械臂的力学控制模型，再对其进行插值运算，用最终计算得到的校正命令轨迹代替平常的命令轨迹，输入到工业机器人机械臂控制系统的输入端，从而保证工业机器人机械臂末端准确地按照设定的希望轨迹运动。

Description

电视机组装线的机械臂控制方法

技术领域

本发明属于控制领域，具体涉及一种电视机组装线的机械臂控制方法。

背景技术

电视机组装线的工业机器人是一种自动控制、可重复编程、仿人操作的机电一体化自动化生产设备，其最主要的部件是电视机组装线的机械臂，即本发明中所称的机械臂。这种机械臂是一种仿生机电设备，能模拟人手动作通过改变目标物体的位姿来实现作业。可完成搬运、焊接、切割、喷涂及装配等工作。工业机器人机械臂操作可控，可实现人机交互，用途非常广泛。由于工业机器人机械臂的结构特点，整体架构属于费力杠杆形式，并且传动齿轮间隙的存在也会降低机械臂的刚度及运动精度。同时，随着工业机器人需求数量不断增长，电视机组装线的机械臂控制方法也越来越复杂，在整个生产链中，其所消耗的能量也随之不断增长。目前，因此提高机械手臂的负载能力、提高整体控制复杂度的同时，如何能在高效控制的同时，降低能源消耗，成为最迫切的问题。

通常人们是通过减少控制电机电枢电阻和传动环节的摩擦来降低系统功能能耗，但从工业机器人高效利用电能的角度出发，在做出这些改进的同时，进一步分析改进控制方法和原理，实现对机械臂关节驱动系统能耗的主动高效控制，具有十分重要的意义。

发明内容

本发明的目的在于解决上述现有方法中存在的问题，通过计算机器人机械臂控制中所涉及到的能源消耗，同时建立机械臂的力学控制模型，再对其进行插值运算，用最终计算得到的校正命令轨迹代替平常的命令轨迹，输入到工业机器人机械臂控制系统的输入端，从而保证工业机器人机械臂末端准确地按照设定的希望轨迹运动。

本发明是通过以下技术方案实现的：

本发明的电视机组装线的机械臂控制方法，主要包括如下过程：

(1)通过实测或者参数标定的方法标定机械臂的尺寸参数、动力学参数以及关节的控制系统参数；

(2)在控制系统中，通过输入指定机械臂的希望运动轨迹和速度；

(3)通过机械臂的运动算法求解各个关节所受的力矩；

(4)计算各个关节的校正命令轨迹；

(5)以计算出的校正命令来指示机械臂的运动。

进一步地，在第(1)步中，具体包括：

根据系统参数建立控制电机控制机械臂的力学模型为：

其中τ(t)为机械臂的力矩，θ_L为机械臂轴的角度位移，为命令角度位移，A,B,C,E为机械臂第j关节控制系统本身的固有特性参数，可以表示为:

其中，R_e控制电机电枢阻值，J_eff为控制电机有效惯性矩，K_e、K_v、K_p、K_b分别为控制电机力矩比常数、比例常数、位置反馈、误差反馈。

进一步地，在第(3)步中，各个关节所受的力矩τ_j为：

其中，L是Lagrange函数，其为机械臂总动能和总势能的差值，τ_j是机械臂第j关节的力矩，q_j是机械臂连杆j的关节变量；而是关节变量q_j对时间的一阶导数，n表示机械臂的关节数量。

我们首先来计算机械臂的动能，若机械臂连杆j上位置向量j_r的质点质量为dm，则该质点的动能为：

则连杆j的动能K_j为：

其中，j_r是质点在坐标系{j}中向量，T_j是基坐标系到连杆坐标系j的变换矩阵，Trace是求矩阵的迹。

机械臂的总动能为：

接着，计算机械臂的势能，连杆j的势能P_j为：

其中,m_j为连杆j的质量，g^T为重力加速度向量，即g^T＝[g_x g_y g_z 0]。

则总势能为：

进一步地，在步骤(4)中，计算各个关节的校正命令轨迹具体包括：

假定系统在时间区间[0,t]是稳定的，在起始条件

之下，对机械臂的第j个驱动关节，计算上述力学模型，可以得到校正命令轨迹为：

j＝1，2，…_，m；

设采样周期T，采样时间t_k＝k(k＝0，1，…N，N为采样点数)，对τ_j(t)进行等间距采样，并在每个区间[t_k，t_k+1]进行三次插值运算，可以得到：

其中，m_K由下式确定：

其中，n＝N，而λ_k由采样值序列确定。

由上面的计算可以得到校正命令轨迹

进一步地，在步骤(5)中，利用得到的校正命令轨迹来输入控制电机中，以使该命令轨迹控制机械臂的运动。

附图说明

图1为本发明工业机器人机械臂控制方法流程图。

具体实施方式

下面结合附图对本发明作进一步详细描述：

参见图1，对于本发明的机械臂的控制方法，主要包括如下过程：

(1)首先，通过实测或者参数标定的方法标定机械臂的尺寸参数、动力学参数以及关节的控制系统参数；

(2)接着，在控制系统中指定机械臂的希望运动轨迹和速度；

(3)通过机械臂的运动算法求解各个关节所受的力矩；

(4)计算各个关节的校正命令轨迹；

(5)以计算出的校正命令来指示机械臂的运动。

其中第(3)步中，各个关节所受的力矩τ_j为：

其中，L是Lagrange函数，其为机械臂总动能和总势能的差值，τ_j是机械臂第j关节的力矩，q_j是机械臂连杆j的关节变量；而是关节变量q_j对时间的一阶导数，n表示机械臂的关节数量。

我们首先来计算机械臂的动能，若机械臂连杆j上位置向量j_r的质点质量为dm，则该质点的动能为：

则连杆j的动能K_j为：

其中，j_r是质点在坐标系{j}中向量，T_j是基坐标系到连杆坐标系j的变换矩阵，Trace是求矩阵的迹。

机械臂的总动能为：

接着，计算机械臂的势能，连杆j的势能P_j为：

其中,m_j为连杆j的质量，g^T为重力加速度向量，即g^T＝[g_x g_y g_z 0]。

则总势能为：

由上可以算得到各个关节所受的力矩τ_j。

而根据系统参数建立的控制电机控制机械臂的力学模型为：

其中A,B,C,E为机械臂第j关节控制系统本身的固有特性参数，可以表示为:

其中，R_e控制电机电枢阻值，θ_L为机械臂轴的角度位移，为命令角度位移，J_eff为控制电机有效惯性矩，K_e、K_v、K_p、K_b分别为控制电机力矩比常数、比例常数、位置反馈、误差反馈。

假定系统在时间区间[0,t]是稳定的，在起始条件

之下，对机械臂的第j个驱动关节，计算上述力学模型，可以得到校正命令轨迹为：

j＝1，2，…，m；

设采样周期T，采样时间t_k＝k(k＝0，1，…N，N为采样点数)，对τ_j(t)进行等间距采样，并在每个区间[t_k，t_k+1]进行三次插值运算，可以得到：

其中，m_K由下式确定：

其中，n＝N，而λ_k由采样值序列确定。

由上面的计算可以得到校正命令轨迹最后，利用得到的校正命令轨迹来输入控制电机中，以使该命令轨迹控制机械臂的运动。

上述技术方案只是本发明的一种实施方式，对于本领域内的技术人员而言，在本发明公开了应用方法和原理的基础上，很容易做出各种类型的改进或变形，而不仅限于本发明上述具体实施方式所描述的方法，因此前面描述的方式只是优选的，而并不具有限制性的意义。

Claims (4)

1.一种电视机组装线的机械臂控制方法，包括：

(1)通过实测或者参数标定的方法标定电视机组装线的机械臂的尺寸参数、动力学参数以及关节的控制系统参数；

(2)在控制系统中，通过输入指定所述机械臂的希望运动轨迹和速度；

(3)通过所述机械臂的运动算法求解各个关节所受的力矩；

(4)计算各个关节的校正命令轨迹；

(5)以计算出的校正命令来指示所述机械臂的运动。

2.根据权利要求1所述的一种电视机组装线的机械臂控制方法，其中在第(1)步中，具体包括：

根据系统参数建立控制电机控制所述机械臂的力学模型为：

其中τ(t)为机械臂的力矩，θ_L为机械臂轴的角度位移，为命令角度位移，A,B,C,E为机械臂第j关节控制系统本身的固有特性参数，可以表示为:

其中，R_e控制电机电枢阻值，J_eff为控制电机有效惯性矩，K_e、K_v、K_p、K_b分别为控制电机力矩比常数、比例常数、位置反馈、误差反馈。

3.根据权利要求1所述的一种电视机组装线的机械臂控制方法，其中在第(3)步中，各个关节所受的力矩τ_j为：

其中，L是Lagrange函数，其为机械臂总动能和总势能的差值，τ_j是机械臂第j关节的力矩，q_j是机械臂连杆j的关节变量；而是关节变量q_j对时间的一阶导数，n表示机械臂的关节数量。

我们首先来计算机械臂的动能，若机械臂连杆j上位置向量j_r的质点质量为dm，则该质点的动能为：

则连杆j的动能K_j为：

其中，j_r是质点在坐标系{j}中向量，T_j是基坐标系到连杆坐标系j的变换矩阵，Trace是求矩阵的迹。

机械臂的总动能为：

接着，计算机械臂的势能，连杆j的势能P_j为：

其中,m_j为连杆j的质量，g^T为重力加速度向量，即g^T＝[g_x g_y g_z 0]。

则总势能为：

进一步地，在步骤(4)中，计算各个关节的校正命令轨迹具体包括：

假定系统在时间区间[0,t]是稳定的，在起始条件

之下，对机械臂的第j个驱动关节，计算上述力学模型，可以得到校正命令轨迹为：

设采样周期T，采样时间t_k＝k(k＝0，1，…N，N为采样点数)，对τ_j(t)进行等间距采样，并在每个区间[t_k，t_k+1]进行三次插值运算，可以得到：

其中，m_K由下式确定：

其中，n＝N，而λ_k由采样值序列确定。

由上面的计算可以得到校正命令轨迹

4.根据权利要求1所述的一种电视机组装线的机械臂控制方法，其中在步骤(5)中，利用得到的校正命令轨迹来输入控制电机中，以使该命令轨迹控制机械臂的运动。