欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 202210572618X
申请人: 华东交通大学
专利类型:发明专利
专利状态:未下证
专利领域: 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

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的闭区间。