CN106843207A - 穿梭车速度规划控制方法、装置及穿梭车 - Google Patents

穿梭车速度规划控制方法、装置及穿梭车 Download PDF

Info

Publication number
CN106843207A
CN106843207A CN201710003147.XA CN201710003147A CN106843207A CN 106843207 A CN106843207 A CN 106843207A CN 201710003147 A CN201710003147 A CN 201710003147A CN 106843207 A CN106843207 A CN 106843207A
Authority
CN
China
Prior art keywords
shuttle
motion
speed
time
displacement
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.)
Pending
Application number
CN201710003147.XA
Other languages
English (en)
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.)
Beijing Jingdong Qianshi Technology Co Ltd
Original Assignee
Beijing Jingdong Century Trading Co Ltd
Beijing Jingdong Shangke Information 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 Beijing Jingdong Century Trading Co Ltd, Beijing Jingdong Shangke Information Technology Co Ltd filed Critical Beijing Jingdong Century Trading Co Ltd
Priority to CN201710003147.XA priority Critical patent/CN106843207A/zh
Publication of CN106843207A publication Critical patent/CN106843207A/zh
Priority to PCT/CN2017/119003 priority patent/WO2018126967A1/zh
Priority to US16/475,601 priority patent/US11226631B2/en
Pending legal-status Critical Current

Links

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/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/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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle

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)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)
  • Numerical Control (AREA)
  • Escalators And Moving Walkways (AREA)
  • Electron Beam Exposure (AREA)

Abstract

本发明公开一种穿梭车速度规划控制方法、装置及穿梭车，涉及控制领域。其中控制穿梭车从指定位移的起点以指定初始速度开始进行加速运动，其中先进行加速度随时间增加的第一加速运动，再进行加速度随时间减小的第二加速运动；然后控制穿梭车进行匀速运动；最后控制穿梭车进行减速运动，其中先进行加速度随时间减少的第一减速运动，再进行加速度随时间增加的第二减速运动，并以指定末速度到达指定位移的终点。本发明通过对穿梭车行进过程中的加减速过程进行控制，从而在保证行进速度的同时，有效减小速度跳变，提高整体效率。

Description

穿梭车速度规划控制方法、装置及穿梭车
技术领域
本发明涉及控制领域，特别涉及一种穿梭车速度规划控制方法、装置及穿梭车。
背景技术
在现代自动化物流仓库中，直线式往复型轨道穿梭车(Shuttle小车)需要以很高速度(最高速度可以达到4米每秒)运动并准确定位，主要采用伺服放大器进行驱动，配合码尺传感器进行定位。
目前，穿梭车采用固定加速度和减速度的速度曲线方式，如图1所示，其中将整个位移分为三个阶段，其中在第一阶段以给定的加速度进行加速直到最大速度，在第二阶段以匀速进行运动，在第三阶段以给定的加速度进行减速，直到速度减到设定的结束速度。
在上述速度曲线中，当速度变化从加速阶段进入匀速，或从匀速阶段进入减速阶段时，由于加速度的变化，如图2所示，速度会相应发生突变，由于现有伺服放大器具有内部速度PID控制，造成实时速度剧烈波动，定位不准确。
发明内容
本发明实施例提供一种穿梭车速度规划控制方法、装置及穿梭车，通过对穿梭车行进过程中的加减速过程进行控制，从而在保证行进速度的同时，有效减小速度跳变，提高整体效率。
根据本发明的一个方面，提供一种穿梭车速度规划控制方法，包括：
控制穿梭车从指定位移的起点以指定初始速度Vs开始进行加速运动，其中先进行加速度随时间增加的第一加速运动，再进行加速度随时间减小的第二加速运动；
控制穿梭车进行匀速运动；
控制穿梭车进行减速运动，其中先进行加速度随时间减少的第一减速运动，再进行加速度随时间增加的第二减速运动，并以指定末速度Ve到达指定位移的终点。
在一个实施例中，穿梭车进行第一加速运动和第二加速运动所需的时间相同；
穿梭车进行第一降速运动和第二降速运动所需的时间相同。
在一个实施例中，穿梭车进行第一加速运动或第二加速运动所需的时间T1和进行第一降速运动和第二降速运动所需的时间T2满足：
所述时间T1和时间T2的平方差与穿梭车的所述末速度Ve减去初始速度Vs的差值呈正比。
在一个实施例中，判断穿梭车的指定位移是否大于预定门限，其中所述预定门限由所述初始速度Vs和末速度Ve确定；
若穿梭车的指定位移大于预定门限，则执行控制穿梭车从指定位移起点以指定初始速度Vs开始进行加速运动的步骤；
若穿梭车的指定位移不大于预定门限，则穿梭车以预定速度通过指定位移。
在一个实施例中，在所述末速度Ve不小于初始速度Vs时，所述预定门限由所述末速度Ve与初始速度Vs之和、以及所述末速度Ve与初始速度Vs之差确定。
在一个实施例中，所述时间T2的取值范围为Vmax为穿梭车的最高速度，J为加速度参数；
设穿梭车通过所述指定位移仅进行所述加速运动和减速运动，通过对穿梭车的位移函数进行二分法来确定所述时间T2和T1。
在一个实施例中，在所述末速度Ve小于初始速度Vs时，所述预定门限由所述末速度Ve与初始速度Vs之和、以及所述初始速度Vs与末速度Ve之差确定。
在一个实施例中，所述时间T2的取值范围为Vmax为穿梭车的最高速度，J为加速度参数；
设穿梭车通过所述指定位移仅进行所述加速运动和减速运动，通过对穿梭车的位移函数进行二分法来确定所述时间T2和T1。
在一个实施例中，利用所述时间T1和初始速度Vs确定穿梭车进行所述加速运动的升速过程位移；
利用所述时间T2和末速度Ve确定穿梭车进行所述减速运动的降速过程位移；
将所述指定位移减去所述升速过程位移和所述降速过程位移的差值作为穿梭车进行所述匀速运动的匀速过程位移。
在一个实施例中，利用所述匀速过程位移、所述时间T1和初始速度Vs确定穿梭车进行所述匀速运动所需的时间T3。
在一个实施例中，利用所述初始速度Vs、加速度参数J、时间T1、T2和T3确定穿梭车在各时刻的运行速度。
根据本发明的另一方面，提供一种穿梭车速度规划控制装置，包括第一运动控制模块、第二运动控制模块和第三运动控制模块，其中：
第一运动控制模块，用于控制穿梭车从指定位移的起点以指定初始速度Vs开始进行加速运动，其中先进行加速度随时间增加的第一加速运动，再进行加速度随时间减小的第二加速运动；
第二运动控制模块，用于控制穿梭车进行匀速运动；
第三运动控制模块，用于控制穿梭车进行减速运动，其中先进行加速度随时间减少的第一减速运动，再进行加速度随时间增加的第二减速运动，并以指定末速度Ve到达指定位移的终点。
在一个实施例中，穿梭车进行第一加速运动和第二加速运动所需的时间相同；
穿梭车进行第一降速运动和第二降速运动所需的时间相同。
在一个实施例中，穿梭车进行第一加速运动或第二加速运动所需的时间T1和进行第一降速运动和第二降速运动所需的时间T2满足：
所述时间T1和时间T2的平方差与穿梭车的所述末速度Ve减去初始速度Vs的差值呈正比。
在一个实施例中，上述装置还包括速度规划模块和第四运动控制模块，其中：
速度规划模块，用于判断穿梭车的指定位移是否大于预定门限，其中所述预定门限由所述初始速度Vs和末速度Ve确定；若穿梭车的指定位移大于预定门限，则指示第一运动控制模块执行控制穿梭车从指定位移起点以指定初始速度Vs开始进行加速运动的操作；
第四运动控制模块，用于速度规划模块的判断结果，若穿梭车的指定位移不大于预定门限，则穿梭车以预定速度通过指定位移。
在一个实施例中，在所述末速度Ve不小于初始速度Vs时，所述预定门限由所述末速度Ve与初始速度Vs之和、以及所述末速度Ve与初始速度Vs之差确定。
在一个实施例中，速度规划模块具体确定所述时间T2的取值范围为Vmax为穿梭车的最高速度，J为加速度参数；设穿梭车通过所述指定位移仅进行所述加速运动和减速运动，通过对穿梭车的位移函数进行二分法来确定所述时间T2和T1。
在一个实施例中，在所述末速度Ve小于初始速度Vs时，所述预定门限由所述末速度Ve与初始速度Vs之和、以及所述初始速度Vs与末速度Ve之差确定。
在一个实施例中，速度规划模块具体确定所述时间T2的取值范围为Vmax为穿梭车的最高速度，J为加速度参数；设穿梭车通过所述指定位移仅进行所述加速运动和减速运动，通过对穿梭车的位移函数进行二分法来确定所述时间T2和T1。
在一个实施例中，速度规划模块还用于利用所述时间T1和初始速度Vs确定穿梭车进行所述加速运动的升速过程位移；利用所述时间T2和末速度Ve确定穿梭车进行所述减速运动的降速过程位移；将所述指定位移减去所述升速过程位移和所述降速过程位移的差值作为穿梭车进行所述匀速运动的匀速过程位移。
在一个实施例中，速度规划模块还用于利用所述匀速过程位移、所述时间T1和初始速度Vs确定穿梭车进行所述匀速运动所需的时间T3。
在一个实施例中，速度规划模块还用于利用所述初始速度Vs、加速度参数J、时间T1、T2和T3确定穿梭车在各时刻的运行速度。
根据本发明的另一方面，提供一种穿梭车速度规划控制装置，包括存储器和处理器，其中：
存储器，用于存储指令；
处理器，耦合到所述存储器，所述处理器被配置为基于所述存储器存储的指令执行实现上述任一实施例涉及的方法。
根据本发明的另一方面，提供一种穿梭车，包括上述任一实施例涉及的穿梭车速度规划控制装置。
通过以下参照附图对本发明的示例性实施例的详细描述，本发明的其它特征及其优点将会变得清楚。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
图1为现有技术中穿梭车速度曲线示意图。
图2为现有技术中穿梭车加速度曲线示意图。
图3为本发明穿梭车速度规划控制方法一个实施例的示意图。
图4为本发明穿梭车速度规划控制方法另一实施例的示意图。
图5为本发明穿梭车速度曲线示意图。
图6为本发明穿梭车加速度曲线示意图。
图7为本发明穿梭车速度规划控制装置一个实施例的示意图。
图8为本发明穿梭车速度规划控制装置另一实施例的示意图。
图9为本发明穿梭车速度规划控制装置又一实施例的示意图。
图10为本发明穿梭车一个实施例的示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。以下对至少一个示例性实施例的描述实际上仅仅是说明性的，决不作为对本发明及其应用或使用的任何限制。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
除非另外具体说明，否则在这些实施例中阐述的部件和步骤的相对布置、数字表达式和数值不限制本发明的范围。
同时，应当明白，为了便于描述，附图中所示出的各个部分的尺寸并不是按照实际的比例关系绘制的。
对于相关领域普通技术人员已知的技术、方法和设备可能不作详细讨论，但在适当情况下，所述技术、方法和设备应当被视为授权说明书的一部分。
在这里示出和讨论的所有示例中，任何具体值应被解释为仅仅是示例性的，而不是作为限制。因此，示例性实施例的其它示例可以具有不同的值。
应注意到：相似的标号和字母在下面的附图中表示类似项，因此，一旦某一项在一个附图中被定义，则在随后的附图中不需要对其进行进一步讨论。
图3为本发明穿梭车速度规划控制方法一个实施例的示意图。其中：
步骤301，控制穿梭车从指定位移的起点以指定初始速度Vs开始进行加速运动，其中先进行加速度随时间增加的第一加速运动，再进行加速度随时间减小的第二加速运动。
可选地，穿梭车进行第一加速运动和第二加速运动所需的时间相同。
步骤302，控制穿梭车进行匀速运动。
步骤303，控制穿梭车进行减速运动，其中先进行加速度随时间减少的第一减速运动，再进行加速度随时间增加的第二减速运动，并以指定末速度Ve到达指定位移的终点。
可选地，穿梭车进行第一降速运动和第二降速运动所需的时间相同。
可选地，穿梭车进行第一加速运动或第二加速运动所需的时间T1和进行第一降速运动和第二降速运动所需的时间T2满足：
时间T1和时间T2的平方差与穿梭车的末速度Ve减去初始速度Vs的差值呈正比。例如，T1 2-T2 2＝(Ve-Vs)/J，其中J为穿梭车的加速度参数。
基于本发明上述实施例提供的穿梭车速度规划控制方法，通过对穿梭车行进过程中的加减速过程进行控制，从而在保证行进速度的同时，有效减小速度跳变，提高整体效率。
图4为本发明穿梭车速度规划控制方法另一实施例的示意图。其中：
步骤401，判断穿梭车的指定位移是否大于预定门限，其中预定门限由初始速度Vs和末速度Ve确定。
若穿梭车的指定位移大于预定门限，则执行步骤403；若穿梭车的指定位移不大于预定门限，则执行步骤402。
其中，由于初始速度Vs和末速度Ve之间的大小关系不同，因此相应的预定门限也会不同。
例如，在末速度Ve不小于初始速度Vs时，预定门限由末速度Ve与初始速度Vs之和、以及末速度Ve与初始速度Vs之差确定。而在末速度Ve小于初始速度Vs时，预定门限由末速度Ve与初始速度Vs之和、以及初始速度Vs与末速度Ve之差确定。
步骤402，穿梭车以预定速度通过指定位移。之后不再执行本实施例的其它步骤。
步骤403，控制穿梭车从指定位移的起点以指定初始速度Vs开始进行加速运动，其中先进行加速度随时间增加的第一加速运动，再进行加速度随时间减小的第二加速运动。
步骤404，控制穿梭车进行匀速运动。
步骤405，控制穿梭车进行减速运动，其中先进行加速度随时间减少的第一减速运动，再进行加速度随时间增加的第二减速运动，并以指定末速度Ve到达指定位移的终点。
若指定位移不满足预定门限要求，则表明该指定位移过短，在这种情况下就无需进行上述速度规定，仅需控制穿梭车以预定速度匀速通过该指定位置即可。
下面通过具体示例对本发明进行说明。
如图5所示，将指定位移S划分为三个阶段，其中在第一阶段(升速过程位移Sup)中，穿梭车从指定位移的起点以指定初始速度Vs开始，在时间T1内先进行加速度随时间增加的第一加速运动，再在时间T1内进行加速度随时间减小的第二加速运动；接下来在第二阶段(匀速过程位移Sev)，在时间T3内进行匀速运动；然后在第三阶段(降速过程位移Sdown)，在时间T2内进行加速度随时间减少的第一减速运动，再在时间T2内进行加速度随时间增加的第二减速运动，并以指定末速度Ve到达指定位移的终点。
设参数J为加速度的变化率，其为一恒定值。则相应的加速度公式如下：
加速度示意图如图6所示。相应的速度公式如下：
对应的位移公式如下：
由于初始速度Vs、末速度Ve、指定位移S和加速度的变化率J均为已知，由此如果能够求出T1，T2和T3，则位移曲线也就迎刃而解了。
当t＝2T1+2T2+T3时，由公式(2)可得：
若匀速过程位移Sev≥0，则穿梭车的最高速度Vmax即为匀速时的速度，由公式(2)可得：
Vmax＝Vs+JT1 2 (5)
将公式(5)带入公式(4)，可得：
进而由公式(3)可推导出：
如果Sev<0，则没有匀速区，即T3为0，且速度达不到Vmax，由公式(3)和公式(4)可得：
如果将上式中的T2看作变量，则可以当作关于T2的函数，则：
其中相对于区间T2∈[0,+∞)是单调递增的。根据公式(6)得T2的取值上限是
当Ve≥Vs时，T2的最小值为0，则其取值范围为
因此，若给定位移：
则T2存在正数解，令公式(9)中的可采用二分法求解T2。
而当Ve＜Vs时，由公式(4)得：
即T2的最小值为则T2的取值范围是
因此，若给定位移：
则T2存在正数解，令公式(9)中的可采用二分法求解T2。
将求取的T2代入公式(4)中得到T1，进而利用公式(7)，则可求得Sup，Sdown，Sev及T3，将T1，T2，T3代入公式(2)中，便可得到各区域的速度。
具体来时，利用时间T1和初始速度Vs确定穿梭车进行加速运动的升速过程位移，利用时间T2和末速度Ve确定穿梭车进行减速运动的降速过程位移，将指定位移减去升速过程位移和降速过程位移的差值作为穿梭车进行匀速运动的匀速过程位移。利用匀速过程位移、时间T1和初始速度Vs确定穿梭车进行匀速运动所需的时间T3。最后利用初始速度Vs、加速度参数J、时间T1、T2和T3确定穿梭车在各时刻的运行速度。
图7为本发明穿梭车速度规划控制装置一个实施例的示意图。如图7所示，该装置包括第一运动控制模块701、第二运动控制模块702和第三运动控制模块703，其中：
第一运动控制模块701用于控制穿梭车从指定位移的起点以指定初始速度Vs开始进行加速运动，其中先进行加速度随时间增加的第一加速运动，再进行加速度随时间减小的第二加速运动。
可选地，穿梭车进行第一加速运动和第二加速运动所需的时间相同。
第二运动控制模块702用于控制穿梭车进行匀速运动。
第三运动控制模块703用于控制穿梭车进行减速运动，其中先进行加速度随时间减少的第一减速运动，再进行加速度随时间增加的第二减速运动，并以指定末速度Ve到达指定位移的终点。
可选地，穿梭车进行第一降速运动和第二降速运动所需的时间相同。
其中穿梭车进行第一加速运动或第二加速运动所需的时间T1和进行第一降速运动和第二降速运动所需的时间T2可满足：
时间T1和时间T2的平方差与穿梭车的末速度Ve减去初始速度Vs的差值呈正比。
基于本发明上述实施例提供的穿梭车速度规划控制装置，通过对穿梭车行进过程中的加减速过程进行控制，从而在保证行进速度的同时，有效减小速度跳变，提高整体效率。
图8为本发明穿梭车速度规划控制装置另一实施例的示意图。如图8所示，该装置中除第一运动控制模块801、第二运动控制模块802和第三运动控制模块803之外，还包括速度规划模块804和第四运动控制模块805。其中：
速度规划模块804用于判断穿梭车的指定位移是否大于预定门限，其中预定门限由初始速度Vs和末速度Ve确定；若穿梭车的指定位移大于预定门限，则指示第一运动控制模块801执行控制穿梭车从指定位移起点以指定初始速度Vs开始进行加速运动的操作；
第四运动控制模块805用于速度规划模块804的判断结果，若穿梭车的指定位移不大于预定门限，则穿梭车以预定速度通过指定位移。
其中，在末速度Ve不小于初始速度Vs时，预定门限由末速度Ve与初始速度Vs之和、以及末速度Ve与初始速度Vs之差确定。而在末速度Ve小于初始速度Vs时，预定门限由末速度Ve与初始速度Vs之和、以及初始速度Vs与末速度Ve之差确定。
此外，速度规划模块804还用户确定穿梭车在各区间的时间、速度、位移等信息，并将确定的相应参数提供给相应的运动控制模块对穿梭车进行相应控制。
例如，在末速度Ve不小于初始速度Vs时，速度规划模块804具体确定时间T2的取值范围为Vmax为穿梭车的最高速度，J为加速度参数；设穿梭车通过指定位移仅进行加速运动和减速运动，根据上述公式(9)，通过对穿梭车的位移函数进行二分法来确定时间T2和T1。
而在末速度Ve小于初始速度Vs时，速度规划模块804具体确定时间T2的取值范围为Vmax为穿梭车的最高速度，J为加速度参数；设穿梭车通过指定位移仅进行加速运动和减速运动，根据上述公式(9)，通过对穿梭车的位移函数进行二分法来确定时间T2和T1。
可选地，速度规划模块804还用于利用时间T1和初始速度Vs确定穿梭车进行加速运动的升速过程位移；利用时间T2和末速度Ve确定穿梭车进行减速运动的降速过程位移；将指定位移减去升速过程位移和降速过程位移的差值作为穿梭车进行匀速运动的匀速过程位移。
此外，速度规划模块804还用于利用匀速过程位移、时间T1和初始速度Vs确定穿梭车进行匀速运动所需的时间T3。
例如，可通过上述公式(7)完成相关计算。
之后，速度规划模块804还可利用上述公式(2)，利用初始速度Vs、加速度参数J、时间T1、T2和T3确定穿梭车在各时刻的运行速度。
图9为本发明穿梭车速度规划控制装置又一实施例的示意图。如图9所示，穿梭车速度规划控制装置可包括存储器901和处理器902，其中：
存储器901用于存储指令，处理器902耦合到存储器901，处理器902被配置为基于存储器存储的指令执行实现如图3或图4中任一实施例涉及的方法。
如图9所示，穿梭车速度规划控制装置还包括通信接口903，用于与其它设备进行信息交互。同时，该装置还包括总线904，处理器902、通信接口903、以及存储器901通过总线904完成相互间的通信。
存储器901可以包含高速RAM存储器，也可还包括非易失性存储器(non-volatilememory)，例如至少一个磁盘存储器。存储器901也可以是存储器阵列。存储器901还可能被分块，并且块可按一定的规则组合成虚拟卷。
此外，处理器902可以是一个中央处理器CPU，或者可以是专用集成电路ASIC(Application Specific Integrated Circuit)，或者是被配置成实施本发明实施例的一个或多个集成电路。
图10为本发明穿梭车一个实施例的示意图。如图10所示，穿梭车1001中包括穿梭车速度规划控制装置1002，其中穿梭车速度规划控制装置1002可为图7至图9中任一实施例涉及的穿梭车速度规划控制装置。
通过实施本发明，能够在保证精度的条件下,使用加减速控制技术对行进路径加减速过程进行控制,提高行进速度,减小速度跳变,提高整体效率。
本领域内的技术人员应明白，本发明的实施例可提供为方法、系统、或计算机程序产品。因此，本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用非瞬时性存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明是参照根据本发明实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
本发明的描述是为了示例和描述起见而给出的，而并不是无遗漏的或者将本发明限于所公开的形式。很多修改和变化对于本领域的普通技术人员而言是显然的。选择和描述实施例是为了更好说明本发明的原理和实际应用，并且使本领域的普通技术人员能够理解本发明从而设计适于特定用途的带有各种修改的各种实施例。

Claims (24)

1.一种穿梭车速度规划控制方法，其特征在于，包括：
控制穿梭车从指定位移的起点以指定初始速度Vs开始进行加速运动，其中先进行加速度随时间增加的第一加速运动，再进行加速度随时间减小的第二加速运动；
控制穿梭车进行匀速运动；
控制穿梭车进行减速运动，其中先进行加速度随时间减少的第一减速运动，再进行加速度随时间增加的第二减速运动，并以指定末速度Ve到达指定位移的终点。
2.根据权利要求1所述的方法，其特征在于，还包括：
穿梭车进行第一加速运动和第二加速运动所需的时间相同；
穿梭车进行第一降速运动和第二降速运动所需的时间相同。
3.根据权利要求2所述的方法，其特征在于，还包括：
穿梭车进行第一加速运动或第二加速运动所需的时间T1和进行第一降速运动和第二降速运动所需的时间T2满足：
所述时间T1和时间T2的平方差与穿梭车的所述末速度Ve减去初始速度Vs的差值呈正比。
4.根据权利要求1-3中任一项所述的方法，其特征在于，还包括：
判断穿梭车的指定位移是否大于预定门限，其中所述预定门限由所述初始速度Vs和末速度Ve确定；
若穿梭车的指定位移大于预定门限，则执行控制穿梭车从指定位移起点以指定初始速度Vs开始进行加速运动的步骤；
若穿梭车的指定位移不大于预定门限，则穿梭车以预定速度通过指定位移。
5.根据权利要求4所述的方法，其特征在于，还包括：
在所述末速度Ve不小于初始速度Vs时，所述预定门限由所述末速度Ve与初始速度Vs之和、以及所述末速度Ve与初始速度Vs之差确定。
6.根据权利要求5所述的方法，其特征在于，还包括：
所述时间T2的取值范围为Vmax为穿梭车的最高速度，J为加速度参数；
设穿梭车通过所述指定位移仅进行所述加速运动和减速运动，通过对穿梭车的位移函数进行二分法来确定所述时间T2和T1。
7.根据权利要求4所述的方法，其特征在于，还包括：
在所述末速度Ve小于初始速度Vs时，所述预定门限由所述末速度Ve与初始速度Vs之和、以及所述初始速度Vs与末速度Ve之差确定。
8.根据权利要求7所述的方法，其特征在于，还包括：
所述时间T2的取值范围为Vmax为穿梭车的最高速度，J为加速度参数；
设穿梭车通过所述指定位移仅进行所述加速运动和减速运动，通过对穿梭车的位移函数进行二分法来确定所述时间T2和T1。
9.根据权利要求6或8所述的方法，其特征在于，还包括：
利用所述时间T1和初始速度Vs确定穿梭车进行所述加速运动的升速过程位移；
利用所述时间T2和末速度Ve确定穿梭车进行所述减速运动的降速过程位移；
将所述指定位移减去所述升速过程位移和所述降速过程位移的差值作为穿梭车进行所述匀速运动的匀速过程位移。
10.根据权利要求9所述的方法，其特征在于，还包括：
利用所述匀速过程位移、所述时间T1和初始速度Vs确定穿梭车进行所述匀速运动所需的时间T3。
11.根据权利要求10所述的方法，其特征在于，还包括：
利用所述初始速度Vs、加速度参数J、时间T1、T2和T3确定穿梭车在各时刻的运行速度。
12.一种穿梭车速度规划控制装置，其特征在于，包括第一运动控制模块、第二运动控制模块和第三运动控制模块，其中：
第一运动控制模块，用于控制穿梭车从指定位移的起点以指定初始速度Vs开始进行加速运动，其中先进行加速度随时间增加的第一加速运动，再进行加速度随时间减小的第二加速运动；
第二运动控制模块，用于控制穿梭车进行匀速运动；
第三运动控制模块，用于控制穿梭车进行减速运动，其中先进行加速度随时间减少的第一减速运动，再进行加速度随时间增加的第二减速运动，并以指定末速度Ve到达指定位移的终点。
13.根据权利要求12所述的装置，其特征在于，还包括：
穿梭车进行第一加速运动和第二加速运动所需的时间相同；
穿梭车进行第一降速运动和第二降速运动所需的时间相同。
14.根据权利要求13所述的装置，其特征在于，还包括：
穿梭车进行第一加速运动或第二加速运动所需的时间T1和进行第一降速运动和第二降速运动所需的时间T2满足：
所述时间T1和时间T2的平方差与穿梭车的所述末速度Ve减去初始速度Vs的差值呈正比。
15.根据权利要求12-14中任一项所述的装置，其特征在于，还包括速度规划模块和第四运动控制模块，其中：
速度规划模块，用于判断穿梭车的指定位移是否大于预定门限，其中所述预定门限由所述初始速度Vs和末速度Ve确定；若穿梭车的指定位移大于预定门限，则指示第一运动控制模块执行控制穿梭车从指定位移起点以指定初始速度Vs开始进行加速运动的操作；
第四运动控制模块，用于速度规划模块的判断结果，若穿梭车的指定位移不大于预定门限，则穿梭车以预定速度通过指定位移。
16.根据权利要求15所述的装置，其特征在于，还包括：
在所述末速度Ve不小于初始速度Vs时，所述预定门限由所述末速度Ve与初始速度Vs之和、以及所述末速度Ve与初始速度Vs之差确定。
17.根据权利要求16所述的装置，其特征在于，还包括：
速度规划模块具体确定所述时间T2的取值范围为Vmax为穿梭车的最高速度，J为加速度参数；设穿梭车通过所述指定位移仅进行所述加速运动和减速运动，通过对穿梭车的位移函数进行二分法来确定所述时间T2和T1。
18.根据权利要求15所述的装置，其特征在于，还包括：
在所述末速度Ve小于初始速度Vs时，所述预定门限由所述末速度Ve与初始速度Vs之和、以及所述初始速度Vs与末速度Ve之差确定。
19.根据权利要求16所述的装置，其特征在于，还包括：
速度规划模块具体确定所述时间T2的取值范围为Vmax为穿梭车的最高速度，J为加速度参数；设穿梭车通过所述指定位移仅进行所述加速运动和减速运动，通过对穿梭车的位移函数进行二分法来确定所述时间T2和T1。
20.根据权利要求17或19所述的装置，其特征在于，还包括：
速度规划模块还用于利用所述时间T1和初始速度Vs确定穿梭车进行所述加速运动的升速过程位移；利用所述时间T2和末速度Ve确定穿梭车进行所述减速运动的降速过程位移；将所述指定位移减去所述升速过程位移和所述降速过程位移的差值作为穿梭车进行所述匀速运动的匀速过程位移。
21.根据权利要求20所述的装置，其特征在于，还包括：
速度规划模块还用于利用所述匀速过程位移、所述时间T1和初始速度Vs确定穿梭车进行所述匀速运动所需的时间T3。
22.根据权利要求21所述的装置，其特征在于，还包括：
速度规划模块还用于利用所述初始速度Vs、加速度参数J、时间T1、T2和T3确定穿梭车在各时刻的运行速度。
23.一种穿梭车速度规划控制装置，其特征在于，包括存储器和处理器，其中：
存储器，用于存储指令；
处理器，耦合到所述存储器，所述处理器被配置为基于所述存储器存储的指令执行实现如权利要求1-11中任一项所述的方法。
24.一种穿梭车，其特征在于，包括如权利要求12-23中任一项所述的穿梭车速度规划控制装置。
CN201710003147.XA 2017-01-03 2017-01-03 穿梭车速度规划控制方法、装置及穿梭车 Pending CN106843207A (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201710003147.XA CN106843207A (zh) 2017-01-03 2017-01-03 穿梭车速度规划控制方法、装置及穿梭车
PCT/CN2017/119003 WO2018126967A1 (zh) 2017-01-03 2017-12-27 穿梭车速度规划控制方法、装置及穿梭车
US16/475,601 US11226631B2 (en) 2017-01-03 2017-12-27 Shuttle vehicle speed control method and apparatus, and shuttle vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710003147.XA CN106843207A (zh) 2017-01-03 2017-01-03 穿梭车速度规划控制方法、装置及穿梭车

Publications (1)

Publication Number Publication Date
CN106843207A true CN106843207A (zh) 2017-06-13

Family

ID=59116767

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710003147.XA Pending CN106843207A (zh) 2017-01-03 2017-01-03 穿梭车速度规划控制方法、装置及穿梭车

Country Status (3)

Country Link
US (1) US11226631B2 (zh)
CN (1) CN106843207A (zh)
WO (1) WO2018126967A1 (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018126967A1 (zh) * 2017-01-03 2018-07-12 北京京东尚科信息技术有限公司 穿梭车速度规划控制方法、装置及穿梭车
CN110271804A (zh) * 2018-03-15 2019-09-24 深圳志合天成科技有限公司 自动存取装置的运动控制方法、装置、设备及存储介质
CN110398993A (zh) * 2018-04-24 2019-11-01 北京京东尚科信息技术有限公司 速度控制方法、装置及计算机可读存储介质
CN110597309A (zh) * 2019-09-23 2019-12-20 北京致行慕远科技有限公司 移动产品的控制方法、装置、系统、存储介质和处理器
CN113060590A (zh) * 2021-03-19 2021-07-02 诸暨兴大豪科技开发有限公司 铺布机的控制方法、装置及储存介质
CN114137978A (zh) * 2021-11-29 2022-03-04 佛山市毕佳索智能科技有限公司 一种仓储agv的速度规划与控制方法
CN114408440A (zh) * 2022-04-02 2022-04-29 山东西曼克技术有限公司 冷库用四向穿梭车速度跟踪控制方法及控制系统

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111198561B (zh) * 2019-12-05 2021-10-22 浙江大华技术股份有限公司 目标跟踪的运动控制方法、装置、计算机设备及存储介质
CN112520581B (zh) * 2020-12-04 2023-09-05 上海驭矩信息科技有限公司 一种提高轮胎式起重机大车运动控制精度的方法及系统
CN114249054B (zh) * 2021-12-27 2024-08-20 江苏智库智能科技有限公司 一种执行多任务的处理方法及四向穿梭车
CN114510062B (zh) * 2022-03-28 2022-07-26 山东西曼克技术有限公司 穿梭车导航控制方法及系统
CN117261974B (zh) * 2023-11-17 2024-02-09 北京全路通信信号研究设计院集团有限公司 一种基于二分法的计算模式限速值计算算法及系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040225382A1 (en) * 2003-05-09 2004-11-11 Phil Brown Jerk profile, vector motion control and real time position capture in motion control systems
KR100819654B1 (ko) * 2006-07-28 2008-04-04 호서대학교 산학협력단 비대칭 에스 커브를 이용한 모터 제어 방법
CN101477354A (zh) * 2009-01-19 2009-07-08 东元总合科技（杭州）有限公司 位置s型指令产生方法
CN103713581A (zh) * 2013-12-12 2014-04-09 南京工程学院 运动控制系统s曲线加减速的实现方法
CN104090596A (zh) * 2014-06-27 2014-10-08 北京工业大学 一种基于粒子群优化算法的五阶段s曲线加减速控制方法

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3934515A (en) * 1972-11-09 1976-01-27 Lon H. Romanski Transportation system
US4155426A (en) * 1978-05-05 1979-05-22 Westinghouse Electric Corp. Digital speed pattern generator
JP2007086904A (ja) * 2005-09-20 2007-04-05 Brother Ind Ltd 加速度軌跡生成装置
KR100793486B1 (ko) 2006-10-27 2008-01-14 현대자동차주식회사 네비게이션의 조그셔틀 다중 키 성능 개선 구조
CN101847003B (zh) 2010-05-24 2013-06-12 三一重型装备有限公司 一种梭车行驶控制系统及梭车
CN102897460A (zh) 2012-09-14 2013-01-30 上海精星仓储设备工程有限公司 用于自动化立体仓库磁栅尺定位分配穿梭车
CN103818672B (zh) * 2014-02-28 2016-06-29 上海速锐物流科技有限公司 一种三维立体行驶的智能穿梭车及其控制方法
CN104229370B (zh) 2014-09-26 2016-08-24 昆明七零五所科技发展总公司 一种具有转向功能的轨道穿梭车的定位装置及定位方法
CN106115197A (zh) * 2016-07-04 2016-11-16 长沙长泰智能装备有限公司 穿梭车定位系统及控制方法
CN106647749A (zh) 2016-11-30 2017-05-10 上海精星仓储设备工程有限公司 一种基于密集存储库内穿梭车行走精确定位的方法
CN106843207A (zh) 2017-01-03 2017-06-13 北京京东尚科信息技术有限公司 穿梭车速度规划控制方法、装置及穿梭车

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040225382A1 (en) * 2003-05-09 2004-11-11 Phil Brown Jerk profile, vector motion control and real time position capture in motion control systems
KR100819654B1 (ko) * 2006-07-28 2008-04-04 호서대학교 산학협력단 비대칭 에스 커브를 이용한 모터 제어 방법
CN101477354A (zh) * 2009-01-19 2009-07-08 东元总合科技（杭州）有限公司 位置s型指令产生方法
CN103713581A (zh) * 2013-12-12 2014-04-09 南京工程学院 运动控制系统s曲线加减速的实现方法
CN104090596A (zh) * 2014-06-27 2014-10-08 北京工业大学 一种基于粒子群优化算法的五阶段s曲线加减速控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
王俊: "《穿梭车控制系统研究》", 《中国优秀硕士学位论文全文数据库信息科技辑》 *

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018126967A1 (zh) * 2017-01-03 2018-07-12 北京京东尚科信息技术有限公司 穿梭车速度规划控制方法、装置及穿梭车
US11226631B2 (en) 2017-01-03 2022-01-18 Beijing Jingdong Qianshi Technology Co., Ltd. Shuttle vehicle speed control method and apparatus, and shuttle vehicle
CN110271804A (zh) * 2018-03-15 2019-09-24 深圳志合天成科技有限公司 自动存取装置的运动控制方法、装置、设备及存储介质
CN110271804B (zh) * 2018-03-15 2021-10-15 深圳志合天成科技有限公司 自动存取装置的运动控制方法、装置、设备及存储介质
CN110398993A (zh) * 2018-04-24 2019-11-01 北京京东尚科信息技术有限公司 速度控制方法、装置及计算机可读存储介质
CN110398993B (zh) * 2018-04-24 2022-09-06 北京京东尚科信息技术有限公司 速度控制方法、装置及计算机可读存储介质
CN110597309A (zh) * 2019-09-23 2019-12-20 北京致行慕远科技有限公司 移动产品的控制方法、装置、系统、存储介质和处理器
CN110597309B (zh) * 2019-09-23 2022-03-29 纳恩博（常州）科技有限公司 移动产品的控制方法、装置、系统、存储介质和处理器
CN113060590A (zh) * 2021-03-19 2021-07-02 诸暨兴大豪科技开发有限公司 铺布机的控制方法、装置及储存介质
CN114137978A (zh) * 2021-11-29 2022-03-04 佛山市毕佳索智能科技有限公司 一种仓储agv的速度规划与控制方法
CN114408440A (zh) * 2022-04-02 2022-04-29 山东西曼克技术有限公司 冷库用四向穿梭车速度跟踪控制方法及控制系统
CN114408440B (zh) * 2022-04-02 2022-07-26 山东西曼克技术有限公司 冷库用四向穿梭车速度跟踪控制方法及控制系统

Also Published As

Publication number Publication date
US11226631B2 (en) 2022-01-18
US20190324469A1 (en) 2019-10-24
WO2018126967A1 (zh) 2018-07-12

Similar Documents

Publication Publication Date Title
CN106843207A (zh) 穿梭车速度规划控制方法、装置及穿梭车
CN104412185B (zh) 用于根据轮廓的图案控制机器的方法和激光切割机
CN107368639A (zh) 速度规划方法、装置、计算机设备和存储介质
CN110109491A (zh) 连续s曲线加减速运动控制方法、系统及电子设备
CN107479581A (zh) 货箱码放控制装置、系统、方法和存储介质
CN107844058A (zh) 一种运动曲线离散动态规划方法
CN107070329A (zh) S型运行曲线计算方法以及步进电机旋转控制方法
CN105182906B (zh) 基于高阶s型运动轨迹的位置与速度控制方法
CN106444645A (zh) 一种基于嵌入式裁床控制器的多轴联动运动控制方法
CN106020122B (zh) 基于牛顿迭代的数控轨迹控制方法
CN103941647A (zh) 用于嵌入式数控设备的柔性加减速控制插补方法
CN107678325B (zh) 一种基于实时操作系统和fpga的转台伺服控制方法
CN106950923A (zh) 一种定插补周期的速度规划方法
CN107153404A (zh) 能够增加程序指令的解析位数的数值控制装置
CN107247446A (zh) 异形轨迹控制方法及装置
CN110398993A (zh) 速度控制方法、装置及计算机可读存储介质
CN106743340A (zh) 物流上包控制方法及控制系统
CN104634356B (zh) 用于确定行驶曲线的方法和控制装置及有控制装置的车辆
CN113186665B (zh) 一种缝纫伺服电机的平滑速度规划控制方法
CN102193530A (zh) 一种基于双核构架协同工作的数控系统及控制方法
CN110716451B (zh) 一种基于实时操作系统和fpga的仿真转台前馈控制方法
CN108455214A (zh) 控制车辆的方法、装置、系统、运输设备及电子设备
CN110618640A (zh) 一种速度规划的点胶机示教系统
CN106584861A (zh) 一种3d打印机挤出头梯形速度曲线控制系统
CN106325222A (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
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20190726

Address after: 300457 Tianjin Economic and Technological Development Zone, No. 10 Fourth Avenue, Phase 2, First Floor

Applicant after: Tianjin Jingdong Shentuo Robot Technology Co., Ltd.

Address before: East Building 11, 100195 Beijing city Haidian District xingshikou Road No. 65 west Shan creative garden district 1-4 four layer of 1-4 layer

Applicant before: Beijing Jingdong Shangke Information Technology Co., Ltd.

Applicant before: Beijing Jingdong Century Commerce Co., Ltd.

TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20200522

Address after: Room A1905, 19th floor, No. 2 Building, 18 Kechuang 11th Street, Beijing Daxing District, Beijing

Applicant after: Beijing Jingdong Qianshi Technology Co.,Ltd.

Address before: 300457 Tianjin Economic and Technological Development Zone, No. 10 Fourth Avenue, Phase 2, First Floor

Applicant before: Tianjin Jingdong Shentuo Robot Technology Co.,Ltd.

RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20170613