凿岩机械臂轨迹规划及电液跟踪控制研究

简介

针对液压凿岩机械臂运动控制的平稳性及跟踪精度问题,提出一种关节空间轨迹规划和电液系统模糊PID跟踪控制方法。首先,基于关节空间五次多项式插值方法对关节的位置、角速度及角加速度进行约束,生成含有时间序列的关节角度变量,通过直接控制关节角度完成轨迹规划。采用智能算法模糊PID对液压缸位移进行跟踪控制,将传感器反馈并计算得到的位移偏差值及其变化率作为模糊控制器的输入,经模糊处理后,把输出的3个参数ΔKP、ΔKI、ΔKD加到PID控制器中以此实现动态调参。在V-REP(Virtual-Robot Experimentation Platform)中建立三维SolidWorks的虚拟样机模型,使用MATLAB软件远程API同步模式控制V-REP验证所提轨迹规划方法对工程实际机械臂的有效性。同时,通过模糊工具箱设计模糊控制器并运用Simulink模块对电液跟踪控制系统进行仿真。V-REP及Simulink仿真结果表明:五次多项式轨迹规划可避免机械臂运动过程中速度及加速度的突变,V-REP中机械臂模型运行平稳;模糊PID能有效提高电液系统的跟踪控制精度,系统响应快速,上升时间不到2 s,最大跟踪误差不超过3.3 mm,该结果可满足凿岩机械臂实际施工作业时规定的误差要求。