1.基于最小流量的冗余液压机械臂运动规划方法,其特征在于:步骤一:首先确定机械臂连杆i到连杆i−1 之间的坐标变换关系:(1)
式中: 分别表示第i关节和第i−1关节之间的绕轴旋转变换、沿臂方向位移变换、绕臂旋转变换、沿轴方向位移变换;
步骤二:确定机械臂末端速度和关节角度的运动学关系:(2)
式中,为机械臂末端速度矢量, 为i行,j 列的雅可比矩阵(i
(3)
步骤三:把雅可比矩阵由解算到的关节角度空间转换到液压缸缸速空间: (4)
式中 为把机械臂末端速度转换到缸速空间的伪逆矩阵,为根据设定末端位置微分求出的末端速度;
步骤四:得出系统的能耗与流量关系: (5)
(6)
式中, 为液压缸缸速, 为恒压系统压力,E为冗余液压机械臂能耗;
步骤五:确定液压缸缸速和机械臂末端速度的关系: (7)
式中, 是机械臂末端速度矢量,是机械臂各关节液压缸缸速矢量,是关节速度转化到液压缸缸速的变换矩阵;
步骤六:为了使冗余液压机械臂液压缸速度范数最小,使用拉格朗日乘数法求解关于L 的多元函数最小值: (8)
(9)
对速度范数 和系数 求偏导,并令L 对v 的偏导数为0 可得: (10)
于是可以解得液压缸缸速v:(11)
把式(11)代入式(7)有: (12)
从式(12)中求解 并代入式(11)得到: (13)
步骤七:得出由缸速空间到末端执行器位置空间的伪逆矩阵:(14)
式中J 是雅可比矩阵;
步骤八:将目标轨迹离散化成N 点,设定每两步之间的时间间隔dt,关节角度由求解到的液压缸缸速和前一步的角位置联合确定: (15)
步骤九:对式(15)中求解到的伪逆矩阵引入加权矩阵W,W为对角矩阵,并给出加权矩阵的指数形式,从而求解液压缸缸速的伪逆矩阵为,W赋初始值,且可以动态调整:(16)
步骤十:建立每个关节的角度q 在第k 时刻的表达式: (17)
式中, 为机械臂关节在k+1 时刻的角度, 为k 时刻关节速度,c 为限位梯度函数系数, 为关节角度限位函数;
步骤十一:以关节的流量消耗减少作为优化目标,求取其减小的方向;
(18)
式中, , 对应k 时刻机械臂运动所需流量, 表示加权矩阵的元素, 取值范围为1,2,3; 对应关节𝑖 的权值, 对应k 时刻伪逆雅可比矩阵, 对应k 时刻机械臂末端位置, 为关节角度限位函数;
步骤十二:确定当前求解步的权值是否可以减少流量消耗,如果可以减少流量消耗,即,则依据下式(19)调整权值,调整之后在代入步骤十一计算如此往复,如果不能减少流量消耗,即 ,则保持前一求解步的权值;
(19)
式中, 表示加权矩阵的元素, 表示搜索步长; 表示当前步权值的初始值;
步骤十三:根据步骤十二保持的权值,进行系统轨迹计算,如果能够完成系统轨迹,则当前步骤完成,如果不能完成预期的系统运动轨迹,则将此时的W的值代入到步骤九中,覆盖掉W的初始赋值,重新进行步骤九到步骤十一的运算。
2.根据权利要求1所述的基于最小流量的冗余液压机械臂运动规划方法,其特征在于:所述步骤二中:
(20)
(21)
(22)
(23)
式中, 为机械臂第i关节和第i‑1关节之间沿第i‑1节臂杆方向的移动距离;
为机械臂第i关节绕第i‑1关节转轴的角度; 为机械臂第i关节和i‑1关节转轴方向的移动距离; 为机械臂第i关节以第 关节为轴转过的角度。
3.根据权利要求1所述的基于最小流量的冗余液压机械臂运动规划方法,其特征在于:所述步骤三中:
(24)
(25)
式中,i表示关节序号, 表示液压缸力臂由式(25)计算得出。
4.根据权利要求1所述的基于最小流量的冗余液压机械臂运动规划方法,其特征在于:步骤九中,加权矩阵 赋初始值,加权矩阵 由以下对角矩阵表示,加权矩阵赋初始值设置 ,表示各关节运动速度占机械臂末端运动的权重;
(26)。
5.根据权利要求1所述的基于最小流量的冗余液压机械臂运动规划方法,其特征在于:步骤十二的 搜索步长取值范围为0.001到0.05的闭区间。