王添, 孙玉磊, 朱孟鹏
由于移动液压机械臂与套索的连接处是多关节的,受空间尺寸的限制,无法在套索出口侧安装拉力传感器,造成无法实时反馈末端的摩擦力,液压机械臂在控制中受到拉力与末端摩擦力不对称的影响,形成惯性轨迹增益误差。当前对这种误差采用忽略影响的策略,容易导致实际控制中液压机械臂的轨迹偏离期望,造成控制精度下降,无法满足精确控制的要求,为此,提出一种多关节移动液压机械臂惯性轨迹增益误差控制方法。基于液压机械臂的运动特性,估计多关节移动液压机械臂的正向运动学以及逆向运动学产生的摩擦力。根据液压机械臂动力学方程设置滑模面并对其求导,通过液压机械臂控制理论设计控制方案,补充与摩擦力匹配的拉力补偿项,排除拉力与摩擦力不对称对控制器的干扰。在增添摩擦力与拉力补偿项的基础上,提出轨迹增益优化算法,结合势场函数获得更精准的轨迹增益,利用蒙特卡洛法确定轨迹增益范围,实现液压机械臂轨迹增益误差消除。试验结果表明,增益误差消除后,多关节移动液压机械臂误差控制能力强,轨迹优化效果好。