CN115525051A - 基于编码器自校正的穿梭车行走定位控制方法 - Google Patents

基于编码器自校正的穿梭车行走定位控制方法 Download PDF

Info

Publication number
CN115525051A
CN115525051A CN202211113757.2A CN202211113757A CN115525051A CN 115525051 A CN115525051 A CN 115525051A CN 202211113757 A CN202211113757 A CN 202211113757A CN 115525051 A CN115525051 A CN 115525051A
Authority
CN
China
Prior art keywords
positioning
pos
encoder
value
self
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202211113757.2A
Other languages
English (en)
Other versions
CN115525051B (zh
Inventor
孙袁
姜甲浩
李广勇
王春
焦茂金
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kengic Intelligent Technology Co Ltd
Original Assignee
Kengic Intelligent Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kengic Intelligent Technology Co Ltd filed Critical Kengic Intelligent Technology Co Ltd
Priority to CN202211113757.2A priority Critical patent/CN115525051B/zh
Publication of CN115525051A publication Critical patent/CN115525051A/zh
Priority to PCT/CN2023/118526 priority patent/WO2024055987A1/zh
Priority to KR1020247038828A priority patent/KR20250006201A/ko
Application granted granted Critical
Publication of CN115525051B publication Critical patent/CN115525051B/zh
Priority to US19/069,286 priority patent/US20250199548A1/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20—Control system inputs
    • G05D1/24—Arrangements for determining position or orientation
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/80—Arrangements for reacting to or preventing system or operator failure
    • G05D1/87—Arrangements for reacting to or preventing system or operator failure using redundant control arrangements
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G1/00—Storing articles, individually or in orderly arrangement, in warehouses or magazines
    • B65G1/02—Storage devices
    • B65G1/04—Storage devices mechanical
    • B65G1/0492—Storage devices mechanical with cars adapted to travel in storage aisles
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20—Control system inputs
    • G05D1/24—Arrangements for determining position or orientation
    • G05D1/244—Arrangements for determining position or orientation using passive navigation aids external to the vehicle, e.g. markers, reflectors or magnetic means
    • G05D1/2446—Arrangements for determining position or orientation using passive navigation aids external to the vehicle, e.g. markers, reflectors or magnetic means the passive navigation aids having encoded information, e.g. QR codes or ground control points
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/60—Intended control result
    • G05D1/644—Optimisation of travel parameters, e.g. of energy consumption, journey time or distance
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/60—Intended control result
    • G05D1/646—Following a predefined trajectory, e.g. a line marked on the floor or a flight path
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G1/00—Storing articles, individually or in orderly arrangement, in warehouses or magazines
    • B65G1/02—Storage devices
    • B65G1/04—Storage devices mechanical
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2105/00—Specific applications of the controlled vehicles
    • G05D2105/20—Specific applications of the controlled vehicles for transportation
    • G05D2105/28—Specific applications of the controlled vehicles for transportation of freight
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2107/00—Specific environments of the controlled vehicles
    • G05D2107/70—Industrial sites, e.g. warehouses or factories
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2111/00—Details of signals used for control of position, course, altitude or attitude of land, water, air or space vehicles
    • G05D2111/50—Internal signals, i.e. from sensors located in the vehicle, e.g. from compasses or angular sensors
    • G05D2111/54—Internal signals, i.e. from sensors located in the vehicle, e.g. from compasses or angular sensors for measuring the travel distances, e.g. by counting the revolutions of wheels

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明所述基于编码器自校正的穿梭车行走定位控制方法，提出一种基于轨道定位标识与外置编码器的自校正解决方案，在穿梭车行走经过每一标识处即时地进行信息反馈与更新伺服目标位置，以期随时消除因打滑现象造成的累计误差，穿梭车在随时校正的位置信息引导下实现行走与定位的全闭环控制流程。基于编码器自校正的穿梭车行走定位控制方法包括以下实施阶段：1)定制与初始化；2)自学习；3)自校正；4)、更新目标位置；5)、位置偏移处置。

Description

基于编码器自校正的穿梭车行走定位控制方法
技术领域
本发明涉及一种穿梭车行走定位的新型控制方法，属于物流仓储领域。
背景技术
目前在物流仓储领域，自动化与智能化控制技术得以快速发展，伴随工业和商业用地、人工成本的不断上升，密集型中转库因其能够充分利用空间效能、相应地减少人员劳动力需求而具备较高的作业效率，多层穿梭车因其具有灵活高效的搬运能力而成为常规使用的料箱存储设备。
做为一种效率较高的轨道引导搬运类设备的多层穿梭车，通过安装在货架立柱上的轨道构成的行走平台完成相对层间的载货移动。在行走过程中，行走电机驱动行走轮产生动力，通过行走轮与轨道的相对摩擦产生向前或者向后的动力，从而达到穿梭车沿轨道前后移动的目的。通常，与轨道摩擦产生行走动力时，由于行走轮表面材质、电机输出扭矩、导轨表面不平整带来的行走轮跳动等诸多因素的影响，导致行走电机输出的脉冲数与行走轮实际行程之间存在较大的差距，可将这种现象粗略定义为打滑现象。特别是在穿梭车载重较大、行走速度较高的情况下，上述类型的打滑现象更为明显，使得穿梭车最终无法准确地行走、定位至指定的存取货工位，形成货物输送上的位置偏差、制约到整体物流运输效率的提高与仓储工位的高效管理上。
如上所述，现有技术导致行走轮打滑的影响因素较多，较为突出的可概括有以下几种：1、在从动轮上安装编码器，以从动轮较小的打滑量替代主动轮进行行走距离的校验与纠偏，虽可解决近距离行走定位不准的问题，但对于巷道较长、穿梭车负载较大的工况就难以实现远距离校验性能，仍然明显地存在计量不准、需反正校正的技术难题。如在先公开专利，申请号为CN202110462768.0，申请名称为钢铁冶金轨道布料小车定位及自动布料控制系统。2、采用定位标识计数方式，穿梭车在行走过程中，通过计算穿梭车行走路线上检测到的定位标识的数量，以计算穿梭车实际走过的距离和所处的位置等参数。这种方式对于行走速度不高且货架安装良好的情况，在一定程度上可解决远距离行走定位问题，但对于负载、货架安装质量、以及速度与加速度等参数的要求较高，对于因长时间高负载运行的车辆及货架老化带来的车体行走跳动现象引起的定位标识计数错误情况，尚无法有效应对。如在先公开专利，申请号为CN201910921041.7，申请名称为穿梭车行走控制方法、装置、计算机设备及存储介质。3、通过上位系统的控制器规划精确的运行曲线和电机速度参数输出，通过编码器反馈实时位置来计算剩余的运行距离，虽然通过构建完整全闭环控制模式，但此方式需要为每辆穿梭车配置性能较高的控制器，同时因控制器算例有限而无法同时处理较多控制器的算法结果输出，导致系统设备成本较高、难以大范围推广普及。
有鉴于此，特提出本专利申请。
发明内容
本发明所述的基于编码器自校正的穿梭车行走定位控制方法，在于解决上述现有技术存在的问题而提出一种基于轨道定位标识与外置编码器的自校正解决方案，在穿梭车行走经过每一标识处即时地进行信息反馈与更新伺服目标位置，以期随时消除因打滑现象造成的累计误差，穿梭车在随时校正的位置信息引导下实现行走与定位的全闭环控制流程。
为实现上述设计目的，本申请所述的基于编码器自校正的穿梭车行走定位控制方法包括以下实施阶段：
1)定制与初始化
在穿梭车上设置有至少一个定位传感器，在轨道上连续地间隔排列有数个用于检测定位的定位标识；
穿梭车初次上电时，确定轨道原点、与轨道起始定位标识的位置，编码器数据初始化，设置伺服驱动器初始化位置数据；
2)自学习
穿梭车以低负载、低速运行，遍历每一层货架的每一个定位标识处，记录每一个定位标识对应生成的编码器数值，建立数组Storage[i]以保存对应生成的数据组；
3)自校正
穿梭车执行货物订单运输指令后，由控制器下发目标位置POS_PRI至伺服驱动器，伺服驱动器规划行走曲线并通过电机输出相应脉冲控制行走轮运行参数；
当定位传感器检测到一个定位标识信号后，上传定位信息至控制器，控制器记录当前编码器数值POS_ENC，并逐一与自学习数组Storage[i]中的初始设定值进行比较，以确定由下标i唯一指定的定位标识地址信息；
4)、更新目标位置
确定穿梭车行走至某一定位标识所处工位后，将外置编码器的数值ENC_CD和伺服编码器反馈的实际位置ENC_SV进行比较，即Delta_Pos＝ENC_CD-ENC_SV；
若假如Delta_Pos≠0，由控制器将更新后的目标位置POS_NEW下发给伺服驱动器，伺服驱动器控制行走轮按当前更新后的目标位置POS_NEW执行行走指令；
5)、位置偏移处置
当穿梭车行走至目标位置前一个定位标识处时，降低穿梭车行走速度至较低值并匀速行进；通过此处定位标识时，按上述阶段3)校正与阶段4)更新目标位置流程执行；
当穿梭车行走至目标位置处的定位标识、并且收到控制器发送的停车信号时，立即执行行走中断程序；
记录当前外置编码器的数值POS_ENC，此处定位标识的容许范围为±T，根据穿梭车的行进方向(正向则+，负向则减)，由控制器向穿梭车下发一个包含位置偏移的目标位置指令POS_TAR，其中POS_TAR＝POS_ENC±T；
更新伺服驱动器的最终位置为当前定位标识对应的自学习数组Storage[i]中的数值,伺服驱动器控制行走轮按目标位置指令POS_TAR执行单次行走，以最终消除打滑现象引起的误差。
进一步地，所述的当前编码器数值POS_ENC与自学习数组Storage[i]中的初始设定值进行比较的过程包括以下步骤：
设定自学习数组Storage[i]中i的取值区间为[H_Min,H_Max]，其中，H_Min为定位标识对应地址信息的最小值，H_Max为定位标识对应地址信息的最大值；
步骤⑴设置数组下标i的初值为H_Min；
步骤⑵当定位传感器检测到某一定位标识信号后，将编码器数值POS_ENC与自学习数组Storage[i]中的数值进行比较，即POS_DIF＝|POS_ENC-Storage[i]；
步骤⑶若计算结果POS_DIF处于允许的误差范围之内，即POS_DIF≤POS_TOR，POS_TOR为相邻两个定位标识所容许的位置误差，则将POS_DIF更新为编码器当前数值，同时结束上述比较循环；
反之，若计算结果POS_DIF不处于允许的误差范围之内，即POS_DIF＞POS_TOR，则将数组下标i加1；
步骤⑷判断数组下标i的数值是否超界，当H_Min≤i≤H_Max时，重复进行步骤⑵，直至确定数组下标i的具体数值，以确定由下标i唯一指定的定位标识地址信息；
当数组下标i的数值超界时，控制器判断编码器数值误差过大，无法进行校正，结束循环。
进一步地，所述的定位标识是定位孔、定位突起、定位片、二维码或标签中的任意一种或多种组合。
综上内容，本申请基于编码器自校正的穿梭车行走定位控制方法具有以下优点：
1、本申请针对现有穿梭车大负载、高速行走过程中易出现的打滑现象，提出一种外置编码器+定位标识相结合的自校正控制方案，编码器设置于车体一侧，通过感知检测每一轨道上的标识，即时地对穿梭车行走位置进行校正，从而随时消除行走打滑导致的行程累计误差，实现了穿梭车行走与定位的全闭环控制，显著地提高了一次定位成功率。
2、行走过程中校正后的编码器数值反馈给控制器，能够随时更新伺服目标位置，由控制器通过总线传输方式下发伺服驱动器位置命令，因此对于控制器性能要求不高，能够大范围地实现设备配置，成本较低、定位准确性与安全性均较高。
3、本申请能够兼顾提高定位控制精度和降低控制难度，通过编码器自校正算法能够实时地更新编码器数值及速度规划曲线，降低了穿梭车定位稳定性受诸如行走速度、负载、运行距离以及货架安装质量等参数的不利影响，相应地提高定位的稳定性。
4、应用本申请，能够相应地提高穿梭车运行速度及货架巷道架设长度，显著地提高一次定位成功率，降低了对货架安装质量的较高要求。
附图说明
现结合以下附图来进一步地说明本发明。
图1是本申请所述基于编码器自校正的穿梭车行走定位控制方法的流程图；
图2是控制系统模块示意图；
具体实施方式
实施例1，如图1和图2所示，本申请提出一种应用于立体物流仓储系统的基于编码器自校正的穿梭车行走定位控制方法，该方法包括以下实施阶段：
1)定制与初始化
应用场景为多层货架，货架包括复式输送轨道、以及行走于轨道上的数个穿梭车；
在穿梭车上设置有至少一个定位传感器，该定位传感器可设置于车体上；
在轨道上、间隔一定距离(如1-3米)连续地设置有数个用于检测定位的定位标识，该定位标识可以是定位孔、定位突起、定位片、二维码或标签中的任意一种或多种组合。
当行走至定位标识处时，定位传感器检测到定位信息并上传至控制器，以生成对应该定位信息的编码器数值。
定位信息由设置于轨道一侧的定位标识唯一确定，属于事先设定的地址参数。数个定位标识组成了一组预定确定的参数群组，当定位传感器将某一个定位信息上传至控制器时，意味着穿梭车到达该定位标识唯一指定的所在工位。
如图2所示，穿梭车控制系统包括命令发起、通讯传输、逻辑处理以及执行机构等部分，命令发起分为上位机自动下发以及操作人员通过PC或者HMI收到发起两部分。
如图1所示，控制器收到上位机下发的控制命令后，通过逻辑处理以总线传输形式下发给控制穿梭车行走轮运行的伺服驱动器。
在穿梭车行走定位过程中，通过检测轨道一侧的定位标识，能够根据实时更新的编码器数值，形成定位标识所处工位与伺服驱动器反馈位置之间的比较，比较结果即偏差数据以位置补偿的形式增加到伺服驱动器原设的目标位置，即形成最终的目标位置更新，该更新后的目标位置下发给伺服驱动器，由伺服驱动器控制行走轮按新的行程距离目标执行，从而一次性地行走到位。
穿梭车初次上电时，确定轨道原点、与轨道起始定位标识的位置，编码器数据初始化，设置伺服驱动器初始化位置数据。
2)自学习
穿梭车以低负载、低速运行，遍历每一层货架的每一个定位标识处，记录每一个定位标识对应生成的编码器数值，建立数组Storage[i]以保存对应生成的数据组，该数组中记录的数据组即是穿梭车行走定位的基础。
通过上述自学习与数据存储，建立起自轨道原点、沿行走行程排列的定位标识确定的初始化位置数据，每一个由定位标识对应确定的位置地址是唯一的。
3)自校正
穿梭车执行货物订单运输指令后，由控制器下发目标位置POS_PRI至伺服驱动器，伺服驱动器规划行走曲线并通过电机输出相应脉冲控制行走轮运行参数；
当定位传感器检测到一个定位标识信号后，上传定位信息至控制器，控制器记录当前编码器数值POS_ENC，并逐一与自学习数组Storage[i]中的初始设定值进行比较，以确定由下标i唯一指定的定位标识地址信息，即明确穿梭车行走至哪一个定位标识所处的工位；
所述的当前编码器数值POS_ENC与自学习数组Storage[i]中的初始设定值进行比较的过程包括以下步骤：
设定自学习数组Storage[i]中i的取值区间为[H_Min,H_Max]，其中，H_Min为定位标识对应地址信息的最小值，H_Max为定位标识对应地址信息的最大值；
步骤⑴设置数组下标i的初值为H_Min；
步骤⑵当定位传感器检测到某一定位标识信号后，将编码器数值POS_ENC与自学习数组Storage[i]中的数值进行比较，即POS_DIF＝|POS_ENC-Storage[i]；
步骤⑶若计算结果POS_DIF处于允许的误差范围之内，即POS_DIF≤POS_TOR，POS_TOR为相邻两个定位标识所容许的位置误差，则将POS_DIF更新为编码器当前数值，同时结束上述比较循环；
反之，若计算结果POS_DIF不处于允许的误差范围之内，即POS_DIF＞POS_TOR，则将数组下标i加1；
步骤⑷判断数组下标i的数值是否超界，当H_Min≤i≤H_Max时，重复进行步骤⑵，直至确定数组下标i的具体数值，以确定由下标i唯一指定的定位标识地址信息；
当数组下标i的数值超界时，控制器判断编码器数值误差过大，无法进行校正，结束循环；
4)、更新目标位置
确定穿梭车行走至某一定位标识所处工位后，将外置编码器的数值ENC_CD和伺服编码器反馈的实际位置ENC_SV进行比较，即Delta_Pos＝ENC_CD-ENC_SV；
若假如Delta_Pos≠0，则认为穿梭车在行走过程中行走轮出现了打滑现象，即行走电机输出的脉冲数和行走轮实际行程不一致；此时，为了保证行走电机一次走到正确位置，需要更新伺服电机的目标位置POS_NEW＝POS_PRI+Delta_Pos；
由控制器将更新后的目标位置POS_NEW下发给伺服驱动器，伺服驱动器控制行走轮按当前更新后的目标位置POS_NEW执行行走指令；
5)、位置偏移处置
当穿梭车行走至目标位置前一个定位标识处时，降低穿梭车行走速度至较低值并匀速行进；通过此处定位标识时，按上述阶段3)校正与阶段4)更新目标位置流程执行；
当穿梭车行走至目标位置处的定位标识、并且收到控制器发送的停车信号时，立即执行行走中断程序；
记录当前外置编码器的数值POS_ENC，此处定位标识的容许范围为±T，T的取值范围取决与定位标识的尺寸大小相关；
根据穿梭车的行进方向(正向则+，负向则减)，由控制器向穿梭车下发一个包含位置偏移的目标位置指令POS_TAR，其中POS_TAR＝POS_ENC±T。
更新伺服驱动器的最终位置为当前定位标识对应的自学习数组Storage[i]中的数值,伺服驱动器控制行走轮按目标位置指令POS_TAR执行单次行走，以最终消除打滑现象引起的误差。
如上内容，结合附图中给出的实施例仅是实现本发明目的的优选方案。对于所属领域技术人员来说可以据此得到启示，而直接推导出符合本发明设计构思的其他替代结构。由此得到的其他结构特征，也应属于本发明所述的方案范围。

Claims (3)

1.一种基于编码器自校正的穿梭车行走定位控制方法，其特征在于：包括以下实施阶段：
1)定制与初始化
在穿梭车上设置有至少一个定位传感器，在轨道上连续地间隔排列有数个用于检测定位的定位标识；
穿梭车初次上电时，确定轨道原点、与轨道起始定位标识的位置，编码器数据初始化，设置伺服驱动器初始化位置数据；
2)自学习
穿梭车以低负载、低速运行，遍历每一层货架的每一个定位标识处，记录每一个定位标识对应生成的编码器数值，建立数组Storage[i]以保存对应生成的数据组；
3)自校正
穿梭车执行货物订单运输指令后，由控制器下发目标位置POS_PRI至伺服驱动器，伺服驱动器规划行走曲线并通过电机输出相应脉冲控制行走轮运行参数；
当定位传感器检测到一个定位标识信号后，上传定位信息至控制器，控制器记录当前编码器数值POS_ENC，并逐一与自学习数组Storage[i]中的初始设定值进行比较，以确定由下标i唯一指定的定位标识地址信息；
4)、更新目标位置
确定穿梭车行走至某一定位标识所处工位后，将外置编码器的数值ENC_CD和伺服编码器反馈的实际位置ENC_SV进行比较，即Delta_Pos＝ENC_CD-ENC_SV；
若假如Delta_Pos≠0，由控制器将更新后的目标位置POS_NEW下发给伺服驱动器，伺服驱动器控制行走轮按当前更新后的目标位置POS_NEW执行行走指令；
5)、位置偏移处置
当穿梭车行走至目标位置前一个定位标识处时，降低穿梭车行走速度至较低值并匀速行进；通过此处定位标识时，按上述阶段3)校正与阶段4)更新目标位置流程执行；
当穿梭车行走至目标位置处的定位标识、并且收到控制器发送的停车信号时，立即执行行走中断程序；
记录当前外置编码器的数值POS_ENC，此处定位标识的容许范围为±T，根据穿梭车的行进方向(正向则+，负向则减)，由控制器向穿梭车下发一个包含位置偏移的目标位置指令POS_TAR，其中POS_TAR＝POS_ENC±T；
更新伺服驱动器的最终位置为当前定位标识对应的自学习数组Storage[i]中的数值,伺服驱动器控制行走轮按目标位置指令POS_TAR执行单次行走，以最终消除打滑现象引起的误差。
2.根据权利要求1所述的基于编码器自校正的穿梭车行走定位控制方法，其特征在于：所述的当前编码器数值POS_ENC与自学习数组Storage[i]中的初始设定值进行比较的过程包括以下步骤，
设定自学习数组Storage[i]中i的取值区间为[H_Min,H_Max]，其中，H_Min为定位标识对应地址信息的最小值，H_Max为定位标识对应地址信息的最大值；
步骤⑴设置数组下标i的初值为H_Min；
步骤⑵当定位传感器检测到某一定位标识信号后，将编码器数值POS_ENC与自学习数组Storage[i]中的数值进行比较，即POS_DIF＝|POS_ENC-Storage[i]；
步骤⑶若计算结果POS_DIF处于允许的误差范围之内，即POS_DIF≤POS_TOR，POS_TOR为相邻两个定位标识所容许的位置误差，则将POS_DIF更新为编码器当前数值，同时结束上述比较循环；
反之，若计算结果POS_DIF不处于允许的误差范围之内，即POS_DIF＞POS_TOR，则将数组下标i加1；
步骤⑷判断数组下标i的数值是否超界，当H_Min≤i≤H_Max时，重复进行步骤⑵，直至确定数组下标i的具体数值，以确定由下标i唯一指定的定位标识地址信息；
当数组下标i的数值超界时，控制器判断编码器数值误差过大，无法进行校正，结束循环。
3.根据权利要求1或2所述的基于编码器自校正的穿梭车行走定位控制方法，其特征在于：所述的定位标识是定位孔、定位突起、定位片、二维码或标签中的任意一种或多种组合。
CN202211113757.2A 2022-09-14 2022-09-14 基于编码器自校正的穿梭车行走定位控制方法 Active CN115525051B (zh)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN202211113757.2A CN115525051B (zh) 2022-09-14 2022-09-14 基于编码器自校正的穿梭车行走定位控制方法
PCT/CN2023/118526 WO2024055987A1 (zh) 2022-09-14 2023-09-13 基于编码器自校正的穿梭车行走定位控制方法
KR1020247038828A KR20250006201A (ko) 2022-09-14 2023-09-13 엔코더 자가 보정 기반 셔틀카 주행 정위 제어 방법
US19/069,286 US20250199548A1 (en) 2022-09-14 2025-03-04 Shuttle vehicle traveling and positioning control method based on encoder self-correction

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211113757.2A CN115525051B (zh) 2022-09-14 2022-09-14 基于编码器自校正的穿梭车行走定位控制方法

Publications (2)

Publication Number Publication Date
CN115525051A true CN115525051A (zh) 2022-12-27
CN115525051B CN115525051B (zh) 2024-09-13

Family

ID=84696876

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211113757.2A Active CN115525051B (zh) 2022-09-14 2022-09-14 基于编码器自校正的穿梭车行走定位控制方法

Country Status (4)

Country Link
US (1) US20250199548A1 (zh)
KR (1) KR20250006201A (zh)
CN (1) CN115525051B (zh)
WO (1) WO2024055987A1 (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114770719A (zh) * 2022-05-10 2022-07-22 中铁十四局集团房桥有限公司 一种轨枕自动下料布料装置及自动下料布料方法
WO2024055987A1 (zh) * 2022-09-14 2024-03-21 科捷智能科技股份有限公司 基于编码器自校正的穿梭车行走定位控制方法
CN117806221A (zh) * 2024-03-01 2024-04-02 成川科技(苏州)有限公司 一种伺服行走系统及其控制方法
CN118597644A (zh) * 2024-06-20 2024-09-06 山东华世力自动化科技有限公司 一种玻璃原片穿梭仓的取片机控制方法及其锁紧装置
CN118811333A (zh) * 2024-08-15 2024-10-22 上海胜模仓储设备有限公司 一种四向穿梭车智能库全库无码认址系统及方法
CN119270621A (zh) * 2024-12-09 2025-01-07 维特瑞交通科技有限公司 一种基于交通行走控制单元的动态队列控制与行走方法

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118547929B (zh) * 2024-07-26 2024-11-19 杭州西子智能停车股份有限公司 立体车库搬运器行走控制方法
CN119396060B (zh) * 2024-12-30 2025-03-25 浙江中扬立库技术有限公司 四向穿梭车自动控制系统及方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5809448A (en) * 1995-11-07 1998-09-15 Construcciones Y Auxiliar De Ferrocarriles, S.A. Position detector system for guide vehicles
CN201741039U (zh) * 2010-08-31 2011-02-09 东南大学 行车位置自动跟踪装置
CN108945936A (zh) * 2018-09-10 2018-12-07 上海欧力德物流科技有限公司 一种轨道式rgv的定位换向控制方法
CN111377356A (zh) * 2018-12-28 2020-07-07 上海梅山钢铁股份有限公司 一种具有路径规划算法的半自动装卸桥及控制方法
CN112068558A (zh) * 2020-08-28 2020-12-11 南京音飞储存设备（集团）股份有限公司 一种穿梭车行走定位控制方法
WO2024055987A1 (zh) * 2022-09-14 2024-03-21 科捷智能科技股份有限公司 基于编码器自校正的穿梭车行走定位控制方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101684410B1 (ko) * 2015-09-21 2016-12-20 주식회사 티에스피지 온라인 재고관리가 가능한 셔틀랙 시스템 및 이의 운영방법
CN110716564A (zh) * 2019-09-26 2020-01-21 兰剑智能科技股份有限公司 穿梭车行走控制方法、装置、计算机设备及存储介质
CN114578799A (zh) * 2020-11-17 2022-06-03 沈阳新松机器人自动化股份有限公司 一种四向穿梭车的伺服控制方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5809448A (en) * 1995-11-07 1998-09-15 Construcciones Y Auxiliar De Ferrocarriles, S.A. Position detector system for guide vehicles
CN201741039U (zh) * 2010-08-31 2011-02-09 东南大学 行车位置自动跟踪装置
CN108945936A (zh) * 2018-09-10 2018-12-07 上海欧力德物流科技有限公司 一种轨道式rgv的定位换向控制方法
CN111377356A (zh) * 2018-12-28 2020-07-07 上海梅山钢铁股份有限公司 一种具有路径规划算法的半自动装卸桥及控制方法
CN112068558A (zh) * 2020-08-28 2020-12-11 南京音飞储存设备（集团）股份有限公司 一种穿梭车行走定位控制方法
WO2024055987A1 (zh) * 2022-09-14 2024-03-21 科捷智能科技股份有限公司 基于编码器自校正的穿梭车行走定位控制方法

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114770719A (zh) * 2022-05-10 2022-07-22 中铁十四局集团房桥有限公司 一种轨枕自动下料布料装置及自动下料布料方法
WO2024055987A1 (zh) * 2022-09-14 2024-03-21 科捷智能科技股份有限公司 基于编码器自校正的穿梭车行走定位控制方法
CN117806221A (zh) * 2024-03-01 2024-04-02 成川科技(苏州)有限公司 一种伺服行走系统及其控制方法
CN117806221B (zh) * 2024-03-01 2024-06-14 成川科技(苏州)有限公司 一种伺服行走系统及其控制方法
CN118597644A (zh) * 2024-06-20 2024-09-06 山东华世力自动化科技有限公司 一种玻璃原片穿梭仓的取片机控制方法及其锁紧装置
CN118597644B (zh) * 2024-06-20 2024-11-12 山东华世力自动化科技有限公司 一种玻璃原片穿梭仓的取片机控制方法及其锁紧装置
CN118811333A (zh) * 2024-08-15 2024-10-22 上海胜模仓储设备有限公司 一种四向穿梭车智能库全库无码认址系统及方法
CN119270621A (zh) * 2024-12-09 2025-01-07 维特瑞交通科技有限公司 一种基于交通行走控制单元的动态队列控制与行走方法

Also Published As

Publication number Publication date
WO2024055987A1 (zh) 2024-03-21
US20250199548A1 (en) 2025-06-19
KR20250006201A (ko) 2025-01-10
CN115525051B (zh) 2024-09-13

Similar Documents

Publication Publication Date Title
CN115525051A (zh) 基于编码器自校正的穿梭车行走定位控制方法
CN106020200A (zh) 采用轮毂电机驱动的agv小车及路径规划方法
CN111273657A (zh) 一种rgv小车采用变频器激光自动定位方式
CN205880660U (zh) 一种采用轮毂电机驱动的agv小车
CN104912372A (zh) 一种agv梳型搬运机器人
CN104878970A (zh) 一种agv载车板交换汽车搬运机器人
CN104058261A (zh) 集装箱自动化码头装卸系统和方法
CN101200193A (zh) 行走台车及其系统
CN109765905A (zh) 一种全向智能立体搬运控制系统
CN105501863A (zh) 一种基于温室内精确定位的单轨物流车及其控制方法
CN204715827U (zh) 一种可侧向搬运汽车的智能机器人
CN111026125B (zh) 一种自动导航小车自动纠偏方法
CN104097916A (zh) 双层智能通道多工位自动运输控制系统
CN114839639B (zh) 基于重力储能的多传感器融合的rgv定位系统及方法
CN104692244A (zh) 天车防啃轨装置
CN113306941A (zh) 一种存储搬运机器人的自学定位结构及其自学定位方法
WO2025112483A1 (zh) 一种隧道智能巡检机器人定位装置及方法
CN113107246A (zh) 一种对横移台车精确定位的方法
CN217467179U (zh) 基于重力储能的多传感器融合的rgv定位系统
CN117263036A (zh) 定位方法、装置、系统及光伏阵列半成品安装设备
CN114779759B (zh) 一种四向穿梭车精准运行用的速度调节、定位控制方法
CN116620755A (zh) 穿梭车及其控制方法、装置和调度方法、装置
CN215324891U (zh) 一种用于智能四向搬运机器人的自主学习的定位结构
JPH11134028A (ja) 自走台車の走行システム
CN111734185A (zh) 一种无避让载车板及其姿态调整方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant