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

为了使凿岩机械臂末端能够保持期望初始姿态且平稳、准确地移动至目标位置,提出一种基于末端姿态约束的液压凿岩机械臂运动控制方法。首先,基于雅可比矩阵建立机械臂末端广义速度与关节速度关系;然后,分析驱动油缸结构并采用全微分方法建立机械臂关节速度与油缸伸缩速度的函数关系,从而基于末端姿态不变的约束,建立机械臂末端广义速度与油缸伸缩速度的对应关系;最终通过控制器给定相应电信号直接控制各油缸伸缩速度完成对姿态约束下凿岩机械臂末端广义速度的控制。使用MATLAB和V-REP(Virtual Robot Experimentation Platform)软件分别对凿岩机械臂末端速度与关节速度关系以及三角油缸和梁摆动油缸伸缩量与关节角度对应关系进行验证,确保计算过程的正确性。通过现场实验得出数据表明:在末端姿态约束下控制凿岩机械臂保持某一期望初始姿态运动...