摘要

针对现有LNG装卸场站槽车充装多为手动充装、人工推动接车臂操作困难、劳动强度大、耗时长、效率低等问题,提出一种具备在划定车辆停靠区域情况下自动对接的LNG硬管接车臂的控制方法。一是实时采集各执行机构的位移,换算为各旋转关节运动的角度及角速度,为有效抑制干扰,防止信号突变,引入一阶滞后滤波算法,滤波后反馈给控制系统;二是通过D-H表示法建立接车臂的运动学模型,进行接车臂的正、逆运动学分析;三是在笛卡尔直角坐标空间规划接车臂末端的实时空间位姿及其对应的速度、加速度;四是建立外环角度控制,内环角速度控制的位置速度双环控制器;五是采用Matalb机器人工具验证正运动学解算表达式的正确性及接车臂运动范围仿真,通过阶跃信号仿真双环与单环PID控制算法的控制效果,实际测试表明自动对接准确率可达99%,相比手动对接时间可节约30%,可有效提高对接效率,减少操作人员数量及劳动强度。LNG硬管接车臂的自动对接控制方法能较好地应用于LNG装卸场站槽车充装自动对接,具有一定的推广和参考价值。