基于固定路线往返的工业机车行走系统及方法

专利主权项内容

1.一种基于固定路线往返的工业机车行走方法，其特征在于，基于固定路线往返的工业机车行走系统包括：带式编码器，平行于预设行走路径设置；设于工业机车上的读码器，读码器与带式编码器位于同一水平位置，且位于带式编码器的感应距离内；PLC控制器，与各读码器无线通讯连接，其中，读码器感应工业机车沿预设行走路径过程的当前位置地址编码，并将读取的当前位置地址编码发送至PLC控制器；PLC控制器基于当前位置地址编码及对应工业机车的目标地址编码控制工业机车行驶至目标位置；基于固定路线往返的工业机车行走系统的工业机车行走方法包括如下步骤：S1、PLC控制器接收读码器发送的当前位置地址编码；S2、PLC控制器基于当前位置地址编码及对应工业机车的目标地址编码来计算工业机车当前位置距目标位置的距离；S3、PLC控制器基于当前位置距目标位置的距离来控制对应工业机车的行走速度；工业机车在行走过程中，PLC控制器基于设定的安全距离来控制其中一台工业机车进行避让或停车；基于设定的安全距离来控制其中一台工业机车进行避让或停车具体包括如下步骤：S31、基于作业工业机车的当前位置地址编码来计算两作业工业机车间的距离；S32、若两工业机车间的距离小于设定的安全距离，则获取两车的行驶方向；S33、若两工业机车为同向行驶，则控制在后的工业机车减速或停止行驶；S34、若两工业机车相向行驶，则基于两工业机车的任务顺序来控制任务在后的工业机车进入停车位进行避让；步骤S34具体包括如下步骤：S341、获取离避让工业机车行驶前方最近停车位及行驶后方最近停车位；S342、判断行驶前方最近停车位处于前进工业机车的行驶前方还是行驶后方；S343、若判断行驶前方最近停车位处于前进工业机车的行驶前方，则控制前进工业机车停止行驶，在控制避让工业机车驶入行驶前方最近停车位后，控制前进工业机车继续朝原行驶方向行驶，当前进工业机车驶过避让工业机车所在停车位时，控制避让工业机车驶入预设行走路径，并朝原行驶方向继续行驶；若判断行驶前方最近停车位处于前进工业机车的行驶后方，则控制避让工业机车驶入行驶后方最近停车位，当前进工业机车驶过避让工业机车所在停车位时，控制避让工业机车驶入预设行走路径，并朝原行驶方向继续行驶。