一种耗能最少的2R欠驱动平面机械臂控制方法技术

本发明专利技术公开了一种耗能最少的2R欠驱动平面机械臂控制方法，其通过动力学分析主动臂与欠驱动臂之间的耦合关系，建立欠驱动系统动力学方程，然后将控制目标分两个阶段完成：当欠驱动平面机械臂处于起摆区域时，按照耗能最低原理设计性能指标函数，然后根据此性能指标函数设计Hamilton函数方程，最后将此Hamilton函数方程联立系统动力学方程，通过计算机求解得到起摆区控制律；而在可线性化区域内，将非线性系统近似为线性化系统，按照线性二次型镇定调节器原理设计可线性化区域控制律，使欠驱动平面机械臂能够稳定在竖直向上的平衡点。本发明专利技术在保证2R欠驱动平面机械臂能够实现稳定在竖直向上平衡点的前提下，大大降低了欠驱动系统的能量消耗。

A control method of 2R underactuated planar manipulator with the least energy consumption

The invention discloses a control method for a 2R underactuated planar manipulator with the least energy consumption. By dynamically analyzing the coupling relationship between the active arm and the underactuated arm, the dynamic equation of the underactuated system is established, and then the control target is completed in two stages: when the underactuated planar manipulator is in the swing region, the energy consumption is in accordance with the energy consumption principle. The lowest principle is to design the performance index function, and then the Hamilton function equation is designed according to the performance index function. Finally, the Hamilton function equation is combined with the dynamic equation of the system, and the swing region control law is obtained by computer. In the linearizable region, the nonlinear system is approximated to the linearized system, according to the linearity. The quadratic stabilization regulator is designed to linearize the region control law so that the underactuated planar manipulator can be stabilized at a vertical equilibrium point. The invention greatly reduces the energy consumption of the under-actuated system on the premise that the 2R under-actuated planar manipulator can achieve a stable vertical balance point.

【技术实现步骤摘要】
一种耗能最少的2R欠驱动平面机械臂控制方法
本专利技术涉及一种欠驱动运动系统控制
，尤其涉及一种耗能最少的2R欠驱动平面机械臂控制方法。
技术介绍
Acrobot是一种在垂直平面上运动的欠驱动双连杆机器人。这种机器人仅在肘部有一个驱动器，使得系统在重量、成本及能耗等方面具有很大的优势；同时，驱动装置的减少也使得机器人的动力学模型受到二阶的非完整条件约束，因此要对其进行控制设计具有很大的难度。但是，由于现有的大多数欠驱动系统的控制方法仅能保证系统得到稳定控制，但是其控制过程中消耗的能量比较大，从而导致Acrobot的控制成本较高。因此，为了使Acrobot更具有实际应用价值，需要在保证系统稳定可控的条件下，尽可能降低控制过程中的能量消耗。
技术实现思路
本专利技术的目的是提供一种耗能最少的2R欠驱动平面机械臂控制方法，该控制方法在保证2R欠驱动平面机械臂能够实现稳定在竖直向上平衡点的前提下，大大地降低控制过程中的能量消耗，在实际中更具有应用价值。为了实现上述目的，本专利技术的技术方案包括以下步骤：步骤1：根据二连杆平面臂动力学方程，针对2R欠驱动平面机械臂建立动力学模型；其中，所述2R欠驱动平面机械臂的第一关节为被动臂，其第二关节为主动臂，且所述动力学模型与第一关节和第二关节运动时的状态变量、第一关节和第二关节的结构参数相关。步骤2：将2R欠驱动平面机械臂的运动区域分为起摆区域和可线性化区域。步骤3：判别2R欠驱动平面机械臂所处区域，对2R欠驱动平面机械臂进行分区域控制。步骤3.1：当判别2R欠驱动平面机械臂处于起摆区域时，驱动元件输出第一力矩τ1，使2R欠驱动平面机械臂进入可线性化区域。其中，所述第一力矩τ1的计算方法为：首先按照耗能最低原理确定性能指标J1，并根据所述性能指标和所述动力学模型建立Hamilton函数方程，将所述Hamilton函数方程联立所述动力学模型，计算出所述第一力矩τ1。步骤3.2：当判别2R欠驱动平面机械臂处于可线性化区域时，驱动元件输出第二力矩τ2，使2R欠驱动平面机械臂稳定在竖直向上的位置。其中，所述第二力矩τ2的计算方法为：首先将所述动力学模型近似成线性系统模型，基于线性二次型调节器原理对所述线性系统模型进行计算，计算出所述第二力矩τ2。作为一种具体实施例，当第一关节与竖直向上的方向的夹角小于30度、第二关节与第一关节之间的夹角小于30度、第一关节的角速度小于30度每秒，且第二关节的角速度小于30度每秒时，判别2R欠驱动平面机械臂处于可线性化区域，否则判别2R欠驱动平面机械臂处于起摆区域。作为一种具体实施例，所述动力学模型为：式中，f1(x)、f2(x)、b1(x)、b2(x)为与所述第一关节和第二关节的运动状态变量相关的动力学参数，τ表示驱动元件输出的力矩，x为所述第一关节和第二关节的运动状态变量的合集，即x＝[x1,x2,x3,x4]T，x1表示第一关节的转动角度，x2表示第二关节的转动角度，x3表示第一关节的角速度，x4表示第二关节的角速度，表示第一关节的加速度，表示第二关节的加速度。其中，式中，c1,c2,c3,c4为与所述第一关节和第二关节的结构常量相关的动力学参数：c1＝m1lc12+m2l12+I1，c2＝m1lc22+I2，c3＝m2l1lc2，c4＝m1lc1+m2l1，c5＝m2lc2。式中，m1表示第一关节的质量，l1表示第一关节的长度，lc1表示第一关节的质心与远离驱动元件的端点的距离，I1表示第一关节的转动惯量，m2表示第二关节的质量，l2表示第二关节的长度，lc2表示第二关节的质心与远离驱动元件的端点的距离，I2表示第二关节的转动惯量。进一步地，所述性能指标为其中，R表示第一力矩τ1的权值系数，W(x(tf),tf)表示与2R欠驱动平面机械臂终点时刻tf及其处于终点时刻的状态x(tf)相关的函数：W(x(tf),tf)＝tf+E(x)-Ed+ε，式中，E(x)表示系统能量函数，Ed表示当2R欠驱动平面机械臂处于竖直向上平衡点时的系统势能，ε为合适的正数。其中，Ed＝(c4+c5)g，g表示重力加速度。所述Hamilton函数方程为式中，λ(tk)表示引入的随时间变化的拉格朗日乘子变量，tk表示驱动元件运行的第k个时间点，b(x(tk))表示非线性系统的转矩增益系数，f(x(tk))表示欠驱动运动系统双关节耦合函数，x(tk)表示第k个时间点对应的所述第一关节和第二关节的运动状态变量；则计算出所述第一力矩τ1为：M表示驱动元件的额定转矩。其中，x2(tk)表示第k个时间点对应的第二关节的角速度。其中，且λ(tk)的初始值，即当tk＝0时，λ(0)＝[-2.967,6.617,1.705,0.994]T。进一步地，步骤3所述线性系统模型为：其中，A1,A2,B1,B2为根据泰勒公式计算出的f1(x),f2(x),b1(x),b2(x)在x＝[0,0,0,0]T时的近似值；则通过步骤3.2计算出所述第二力矩τ2为：τ2＝-R-1BTPx。其中，R表示权值系数，B表示步骤1所述的动力学模型经过近似化计算后转矩的增益系数，P表示里黎卡提方程PA+ATP-PBR-1BTP+Q＝0的解，A表示状态增益系数。其中，所述状态增益系数A和转矩增益系数B的计算方式为：基于所述欠驱动系统双关节耦合函数f(x(tk))与转矩增益系数b(x(tk))，根据泰勒定理，在平衡点处，在误差允许范围内通过近似化计算得到f(x(tk))＝Ax(tk)，b(x(tk))＝B，其中，A,B均为常值矩阵。具体地，所述驱动元件为伺服电机。具体地，所述第一关节和第二关节的运动状态变量x＝[x1,x2,x3,x4]T通过传感器检测得出。与现有技术相比，本专利技术具有以下技术效果：针对欠驱动平面机械臂这类二阶非完整系统，本专利技术通过动力学分析主动臂与欠驱动臂之间的耦合关系，建立针对2R欠驱动平面机械臂的动力学方程，然后将控制目标分两个阶段完成：当欠驱动平面机械臂处于起摆区域时，按照耗能最低的原理设计性能指标函数，然后根据此性能指标函数设计Hamilton函数方程，最后将此Hamilton函数方程联立动力学方程，通过计算机求解得到在起摆区域内驱动元件输出力矩的变化规律；而在可线性化区域内，将非线性系统近似为线性化系统，按照线性二次型镇定调节器原理设计可线性化区域内驱动元件输出力矩的变化规律，使欠驱动平面机械臂能够稳定在竖直向上的平衡点。本控制方法使用的是基于最优控制中的一种耗能最低的控制方法。在此方法的设计过程中，以控制力矩作为主要的性能指标，使得此方法在保证2R欠驱动平面机械臂能够实现稳定控制的前提下，极大的降低了欠驱动系统的能量消耗，在实际中更具有应用价值。另外，本控制方法中使用的是具有一般意义下的机械臂结构参数的表示方法，当需要更换不同的欠驱动机械臂进行控制时，只需要更新机械臂的结构参数即可，使得欠驱动系统稳定控制的普适性有了很大的提高。为了更好地理解和实施，下面结合附图详细说明本专利技术。附图说明图1是2R欠驱动平面机械臂的结构示意图。具体实施方式实施例1请参阅图1，本专利技术的2R欠驱动平面机械臂的控制方法包括以下步骤：步骤1：根据二连杆平面臂动力学方程，针对2R欠驱动平面机械臂建立动力学模型；本文档来自技高网...

【技术保护点】
1.一种耗能最少的2R欠驱动平面机械臂控制方法，其特征在于，包括：步骤1：根据二连杆平面臂动力学方程，针对2R欠驱动平面机械臂建立动力学模型；其中，所述2R欠驱动平面机械臂的第一关节为被动臂，其第二关节为主动臂，且所述动力学模型与第一关节和第二关节运动时的状态变量、第一关节和第二关节的结构参数相关；步骤2：将2R欠驱动平面机械臂的运动区域分为起摆区域和可线性化区域；步骤3：判别2R欠驱动平面机械臂所处区域，对2R欠驱动平面机械臂进行分区域控制；当判别2R欠驱动平面机械臂处于起摆区域时，驱动元件输出第一力矩τ1，使2R欠驱动平面机械臂进入可线性化区域；其中，所述第一力矩τ1的计算方法为：首先按照耗能最低原理确定性能指标，并根据所述性能指标和所述动力学模型建立Hamilton函数方程，将所述Hamilton函数方程联立所述动力学模型，计算出所述第一力矩τ1；当判别2R欠驱动平面机械臂处于可线性化区域时，驱动元件输出第二力矩τ2，使2R欠驱动平面机械臂稳定在竖直向上的位置；其中，所述第二力矩τ2的计算方法为：将所述动力学模型近似成线性系统模型，基于线性二次型调节器原理对所述线性系统模型进行计算，计算出所述第二力矩τ2。...

【技术特征摘要】
1.一种耗能最少的2R欠驱动平面机械臂控制方法，其特征在于，包括：步骤1：根据二连杆平面臂动力学方程，针对2R欠驱动平面机械臂建立动力学模型；其中，所述2R欠驱动平面机械臂的第一关节为被动臂，其第二关节为主动臂，且所述动力学模型与第一关节和第二关节运动时的状态变量、第一关节和第二关节的结构参数相关；步骤2：将2R欠驱动平面机械臂的运动区域分为起摆区域和可线性化区域；步骤3：判别2R欠驱动平面机械臂所处区域，对2R欠驱动平面机械臂进行分区域控制；当判别2R欠驱动平面机械臂处于起摆区域时，驱动元件输出第一力矩τ1，使2R欠驱动平面机械臂进入可线性化区域；其中，所述第一力矩τ1的计算方法为：首先按照耗能最低原理确定性能指标，并根据所述性能指标和所述动力学模型建立Hamilton函数方程，将所述Hamilton函数方程联立所述动力学模型，计算出所述第一力矩τ1；当判别2R欠驱动平面机械臂处于可线性化区域时，驱动元件输出第二力矩τ2，使2R欠驱动平面机械臂稳定在竖直向上的位置；其中，所述第二力矩τ2的计算方法为：将所述动力学模型近似成线性系统模型，基于线性二次型调节器原理对所述线性系统模型进行计算，计算出所述第二力矩τ2。2.根据权利要求1所述的2R欠驱动平面机械臂控制方法，其特征在于：当第一关节与竖直向上的方向的夹角小于30度、第二关节与第一关节之间的夹角小于30度、第一关节的角速度小于30度每秒，且第二关节的角速度小于30度每秒时，判别2R欠驱动平面机械臂处于可线性化区域，否则判别2R欠驱动平面机械臂处于起摆区域。3.根据权利要求1所述的2R欠驱动平面机械臂控制方法，其特征在于：所述动力学模型为：式中，f1(x)、f2(x)、b1(x)、b2(x)为与所述第一关节和第二关节的运动状态变量相关的动力学参数，τ表示驱动元件输出的力矩，x为所述第一关节和第二关节的运动状态变量的合集，即x＝[x1,x2,x3,x4]T，x1表示第一关节的转动角度，x2表示第二关节的转动角度，x3表示第一关节的角速度，x4表示第二关节的角速度，表示第一关节的加速度，表示第二关节的加速度；式中，c1,c2,c3,c4为与所述第一关节和第二关节的结构常量相关的动力学参数：c1＝m1lc12+m2l12+I1，c2＝m1lc22+I2，c3＝m2l1lc2，c4＝m1lc1+m2l1，c5＝m2lc2；式中，m1表示第一关节的质量，l1表示第一关节的长度，lc1表示第一关节的质心与远离驱动元件的端点的距离...

【专利技术属性】
技术研发人员：刘士亚，王能，张志飞，
申请(专利权)人：佛山科学技术学院，
类型：发明
国别省市：广东,44