基于关节速度的液压比例驱动工程机械臂位姿控制

简介

为了解决液压驱动工程机械臂在实际工程作业中加装位置传感器会使得系统复杂,从而可靠性降低,以及在关节处位置闭环伺服控制会导致液压系统效率降低的问题,提出在比例液压油缸驱动的机械臂中用位姿闭环而非关节位置闭环构成机器人控制系统。使用惯性导航、激光雷达、视觉等获得机械臂末端姿态,通过机器人运动学逆解得到当前关节值,与目标关节值形成闭环从而获得关节速度给定值。通过比例液压系统驱动机械臂关节,进而控制位姿变化。推导了负载敏感比例阀控液压油缸传递函数、陀螺仪姿态解算方程并对机械臂进行逆运动学分析。使用MATLAB/Simulink建立基于关节速度控制的液压驱动机械臂位姿闭环控制仿真模型,进行仿真实验,结果验证了控制方法的可行性。