一种四向穿梭车精准运行用的速度调节、定位控制方法技术

本发明专利技术属于四向穿梭车技术领域，尤其涉及一种四向穿梭车精准运行用的速度调节、定位控制方法。本发明专利技术通过依次进行硬件布置、位置信息输入、距离信息输入、行驶指令下达、速度模式行驶以及减速行驶并停车这六步操作的方式，达到四向穿梭车运行更加精准、高效的目的。本发明专利技术具有以下优点：四向穿梭车的减速定位过程非常平稳，到达终点标记位置后再进行位置调整，实现了准确定位，保证了定位精度，与常规的分段减速相比优势明显。段减速相比优势明显。段减速相比优势明显。

A speed adjustment and positioning control method for precise operation of four-way shuttle

【技术实现步骤摘要】
一种四向穿梭车精准运行用的速度调节、定位控制方法


[0001]本专利技术属于四向穿梭车
，尤其涉及一种四向穿梭车精准运行用的速度调节、定位控制方法。

技术介绍

[0002]四向穿梭车，指的是一种智能的仓储物流运输设备，其能前后左右移动，保证托盘货物的有效运输，因此四向穿梭车系统就需要一套合适、有序的控制方法、运行模式，保证运输操作更加有序、安全。
[0003]例如，专利公开号为CN113687650A、公开日为2021.11.23的中国专利技术专利，公开了一种穿梭车运行定位的方法，系统包括总控制器、颜色传感器、激光传感器、若干个不同颜色色条、激光射灯、电脑端。方法包括：步骤S01，电脑端发送的定位信号到总控制器后，颜色传感器识别当前运行轨道段上的色条颜色信息，并与总运行轨道颜色信息进行比较，获得穿梭车当前运行轨道段编号后发送到电脑端。步骤S02，电脑端控制当前运输轨道段对应的激光射灯从运行轨道段一端开始照射转动，直到获得激光传感器的感光信号后，获得此时该激光射灯的转动角度。步骤S03，电脑端通过当前运输轨道段编号、激光射灯的转动角度查询位置表格获得穿梭车当前位置。
[0004]但是，该专利技术专利中的穿梭车运行定位方法，其在使用过程中，至少存在以下3个不足之处。
[0005]第一、穿梭车在运行过程中，缺少合适的距离、位置修正方法，最终使得穿梭车输出的实时参数准确性差。
[0006]第二、不能实现运行过程中减速距离和减速度的完全受控。
[0007]第三、穿梭车到达目标位置后的定位动作不够精准，最终换向脱轨的风险也就增大了。
[0008]所以综上所述，现在急需一种可以让四向穿梭车的运行更加平稳、安全、节能、精准的新型控制方法。

技术实现思路

[0009]本专利技术提供一种四向穿梭车精准运行用的速度调节、定位控制方法，其能通过依次进行硬件布置、位置信息输入、距离信息输入、行驶指令下达、速度模式行驶以及减速行驶并停车这六步操作的方式，达到四向穿梭车运行更加精准、高效的目的。
[0010]本专利技术解决上述问题采用的技术方案是：一种四向穿梭车精准运行用的速度调节、定位控制方法，依次包括以下步骤，S1、硬件布置：将穿梭车轨道上的所有货架位置和穿梭车换向位置，都设定为标记位置，每一个标记位置都安装RFID标签和定位反光贴；S2、位置信息输入：在RFID标签内写入标记位置的位置信息，并将所有位置信息写入四向穿梭车的数据块；
S3、距离信息输入：在数据块内输入所有相邻标记位置之间的行进所需距离，标记位置判别范围距离，以及减速设定距离；S4、行驶指令下达：在四向穿梭车的编码器中读取初始的标记位置信息，并记为特定变量，结合输入下达的终点标记位置信息，计算出本次行驶作业的总行驶距离；S5、速度模式行驶：四向穿梭车在速度模式下行驶，将特定变量实时更新至最近经过的标记位置信息，再结合特定变量之后的行驶距离、下一个标记位置信息以及标记位置判别范围距离这三个参数，判定四向穿梭车是否已经进入下一个标记位置判别范围；S6、减速行驶并停车：四向穿梭车根据实时更新的行驶距离和本次行驶作业的总行驶距离，计算得出剩余行驶距离，在剩余行驶距离减少至减速设定距离时，四向穿梭车受控减速，最终以低速行驶方式，在经过目标位置的定位反光贴时停车，本次行驶作业完成。
[0011]进一步优选的技术方案在于：S2中，位置信息包括仓库号信息、货架号信息、层数信息以及排列位信息。
[0012]进一步优选的技术方案在于：S3中，标记位置判别范围距离为定位反光贴位置的前后1.0
‑
1.2cm。
[0013]进一步优选的技术方案在于：S3中，RFID读码器在四向穿梭车进入标记位置判别范围时打开，在离开标记位置判别范围时关闭。
[0014]进一步优选的技术方案在于：S3中，RFID读码器和定位光电传感器在四向穿梭车进入标记位置判别范围时打开，在离开标记位置判别范围时关闭。
[0015]进一步优选的技术方案在于：S5中，特定变量更新的信号为定位光电传感器检测到定位反光贴，检测精度为前后3mm，此时RFID读码器读取RFID标签的位置信息。
[0016]进一步优选的技术方案在于：S5中，在四向穿梭车行驶至定位光电传感器检测到定位反光贴时，特定变量更新，再根据特定变量与初始标记位置之间的距离，对四向穿梭车的行进完成距离进行修正。
[0017]进一步优选的技术方案在于：S5中，当部分定位反光贴无法被检测到时，四向穿梭车在下一个定位反光贴可以被检测到的标记位置处，进行特定变量更新和行进完成距离的修正。
[0018]进一步优选的技术方案在于：S5中，四向穿梭车经过定位反光贴，并读取编码器信息，以修正行进距离的程序，放入中断中。
[0019]进一步优选的技术方案在于：S6中，四向穿梭车检测到终点标记位置的定位反光贴进而停车时，根据实时更新的行驶距离和终点标记位置的位置信息，计算出四向穿梭车经过定位反光贴后多余的行驶距离，记为需要调整距离，最后将四向穿梭车切换为位置模式以进行倒车，实现满足精度要求的准确定位。
[0020]本专利技术具有以下优点。
[0021]第一，四向穿梭车的减速定位过程非常平稳，到达终点标记位置后再进行位置调整，实现了准确定位，保证了定位精度，与常规的分段减速相比优势明显。
[0022]第二，通过运行中的位置修正，保证了行驶距离的准确性，而且由于是在一个区间范围内检测到定位反光贴后对位置进行修正，使得算法具有很高的容错性，个别定位反光贴没有被检测到并不影响到算法的有效性，显著降低了对现场施工的要求，使得算法具有更好的抗干扰能力。
[0023]第三，为提高位置修正的准确性，四向穿梭车经过定位反光贴，并读取编码器信息，以修正行进距离的程序，放入中断中，以获得更高的执行优选级，提高修正操作的效率。
[0024]第四，通过实时计算四向穿梭车的行驶距离，并与开始行驶前计算出的本次行驶总距离进行比较，计算出距离目标位置的剩余距离，实现减速距离和减速度的完全受控减速。
[0025]第五，在检测到终点标记位置的定位反光贴并停车后，根据停车位置和反光贴位置的编码器值，计算出四向车经过反光贴后的行驶距离，再根据反光贴的位置和定位精度要求计算出需要进行的位置调整，将行走电机工作方式转化为位置模式进行调整，实现满足精度要求的准确定位。
[0026]第六，RFID读码器和定位光电传感器，或者单独是RFID读码器，在四向穿梭车进入标记位置判别范围时才打开，在离开标记位置判别范围时再关闭，保证更加节能的四向穿梭车运行特点。
附图说明
[0027]图1为本专利技术中速度调节、定位控制方法的流程图。
[0028]图2为本专利技术实施例中，四向穿梭车运行时的电机转速变化图，图中A线表示电流，B线表示电机转速。
[0029]图3为现有技术中，常见的四向穿梭车分段减速运行方式的电机转速变化图，图中a线表示电流，b线表示电机转速。本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种四向穿梭车精准运行用的速度调节、定位控制方法，其特征在于依次包括以下步骤，S1、硬件布置：将穿梭车轨道上的所有货架位置和穿梭车换向位置，都设定为标记位置，每一个标记位置都安装RFID标签和定位反光贴；S2、位置信息输入：在RFID标签内写入标记位置的位置信息，并将所有位置信息写入四向穿梭车的数据块；S3、距离信息输入：在数据块内输入所有相邻标记位置之间的行进所需距离，标记位置判别范围距离，以及减速设定距离；S4、行驶指令下达：在四向穿梭车的编码器中读取初始的标记位置信息，并记为特定变量，结合输入下达的终点标记位置信息，计算出本次行驶作业的总行驶距离；S5、速度模式行驶：四向穿梭车在速度模式下行驶，将特定变量实时更新至最近经过的标记位置信息，再结合特定变量之后的行驶距离、下一个标记位置信息以及标记位置判别范围距离这三个参数，判定四向穿梭车是否已经进入下一个标记位置判别范围；S6、减速行驶并停车：四向穿梭车根据实时更新的行驶距离和本次行驶作业的总行驶距离，计算得出剩余行驶距离，在剩余行驶距离减少至减速设定距离时，四向穿梭车受控减速，最终以低速行驶方式，在经过目标位置的定位反光贴时停车，本次行驶作业完成。2.根据权利要求1所述的一种四向穿梭车精准运行用的速度调节、定位控制方法，其特征在于：S2中，位置信息包括仓库号信息、货架号信息、层数信息以及排列位信息。3.根据权利要求1所述的一种四向穿梭车精准运行用的速度调节、定位控制方法，其特征在于：S3中，标记位置判别范围距离为定位反光贴位置的前后1.0
‑
1.2cm。4.根据权利要求1所述的一种四向穿梭车精准运行用的速度调节、定位控制方法，其特征在于：S3中，RFID读码...

【专利技术属性】
技术研发人员：李向荣，韩兵，方辰呈，
申请(专利权)人：浙江世仓智能仓储设备有限公司，
类型：发明
国别省市：