CN106444762B - 自动引导运输车agv及运动控制方法和装置 - Google Patents

自动引导运输车agv及运动控制方法和装置 Download PDF

Info

Publication number
CN106444762B
CN106444762B CN201610901977.XA CN201610901977A CN106444762B CN 106444762 B CN106444762 B CN 106444762B CN 201610901977 A CN201610901977 A CN 201610901977A CN 106444762 B CN106444762 B CN 106444762B
Authority
CN
China
Prior art keywords
agv
speed
deceleration
maximum
travel
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.)
Active
Application number
CN201610901977.XA
Other languages
English (en)
Other versions
CN106444762A (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.)
Beijing Jingdong Qianshi Technology Co Ltd
Original Assignee
Tianjin Jingdong Shentuo Robot 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 Tianjin Jingdong Shentuo Robot Technology Co ltd filed Critical Tianjin Jingdong Shentuo Robot Technology Co ltd
Priority to CN201610901977.XA priority Critical patent/CN106444762B/zh
Publication of CN106444762A publication Critical patent/CN106444762A/zh
Priority to PCT/CN2017/105799 priority patent/WO2018072635A1/zh
Application granted granted Critical
Publication of CN106444762B publication Critical patent/CN106444762B/zh
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/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

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 Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

本发明提出一种自动引导运输车AGV及运动控制方法和装置，涉及物流技术领域。其中，本发明的一种AGV运动控制方法包括：根据路径长度和预定减速度确定AGV的行程规划，行程规划中包括行驶速度最大值和减速点；根据行程规划驱动AGV运动。通过这样的方法，能够根据AGV需要行驶的路径的长度，以及AGV的减速度确定行程规划，使AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。

Description

自动引导运输车AGV及运动控制方法和装置
技术领域
本发明涉及物流技术领域，特别是一种AGV(Automated Guided Vehicle，自动引导运输车)及运动控制方法和装置。
背景技术
在仓储物流领域，自动化程度普遍偏低，现有的物流自动化设备往往采取在检测到将要停车的地标点后进行降速停车，或在检测到将要停车的地标点后降速至爬行速度方式运动，实现AGV沿路径运动后在目标地点停车。
但是，采用在检测到将要停车的地标点后进行降速停车的方式在不同的AGV载荷惯性工况下难以实现停车精度的稳定和精度；而降速至爬行速度的方式会浪费大量的作业时间导致节拍较低，难以满足高速的作业节拍要求。
发明内容
本发明的一个目的在于提高AGV作业的效率和准确度。
根据本发明的一个方面，提出一种AGV运动控制方法，包括：根据路径长度和预定减速度确定AGV的行程规划，行程规划中包括行驶速度最大值和减速点；根据行程规划驱动AGV运动。
可选地，根据路径长度和预定减速度确定AGV的行程规划包括：根据路径长度、预定加速度和预定减速度确定基于路径长度的最大速度；根据基于路径长度的最大速度和预定速度阈值确定AGV的行驶速度最大值；根据行驶速度最大值和预定减速度确定减速点。
可选地，根据路径长度、预定加速度和预定减速度确定基于路径长度的最大速度包括：根据预定加速度确定AGV从当前速度加速到路径速度上限需要行驶的加速长度；根据预定减速度确定AGV从路径速度上限减速到静止状态需要行驶的减速长度；若加速长度与减速长度之和不大于路径长度，则确定基于路径长度的最大速度为路径速度上限；若加速长度与减速长度之和大于路径长度，则确定能够保证AGV停止在目的地点的行程能够达到的最大速度作为基于路径长度的最大速度。
可选地，预定速度阈值包括：AGV的机械结构极限速度、路径中各个路段的最大允许速度，和/或AGV的上位机指令速度；根据基于路径长度的最大速度和预定速度阈值确定AGV的行驶速度最大值包括：从基于路径长度的最大速度和预定速度阈值中选择最小速度作为行驶速度最大值。
可选地，根据行程规划驱动AGV运动包括：驱动AGV以预定加速度加速行驶，达到行驶速度最大值；驱动AGV以行驶速度最大值行驶至减速点；驱动AGV以预定减速度减速行驶直至静止。
可选地，还包括：获取AGV的轮系的实时速度。
可选地，根据行程规划驱动AGV运动包括：通过伺服放大器向轮系发送控制信息，驱动AGV运动。
通过这样的方法，能够根据AGV需要行驶的路径的长度，以及AGV的减速度确定行程规划，使AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。
根据本发明的另一个方面，提出一种AGV运动控制装置，包括：行程规划模块，用于根据路径长度和预定减速度确定AGV的行程规划，行程规划中包括行驶速度最大值和减速点；运动驱动模块，用于根据行程规划驱动AGV运动。
可选地，行程规划模块包括：速度规划单元，用于根据路径长度、预定加速度和预定减速度确定基于路径长度的最大速度；速度仲裁单元，用于根据基于路径长度的最大速度和预定速度阈值确定AGV的行驶速度最大值；减速点确定单元，用于根据行驶速度最大值和预定减速度确定减速点。
可选地，速度规划单元用于：根据预定加速度确定AGV从当前速度加速到路径速度上限需要行驶的加速长度；根据预定减速度确定AGV从路径速度上限减速到静止状态需要行驶的减速长度；若加速长度与减速长度之和不大于路径长度，则确定基于路径长度的最大速度为路径速度上限；若加速长度与减速长度之和大于路径长度，则确定能够保证AGV停止在目的地点的行程能够达到的最大速度作为基于路径长度的最大速度。
可选地，预定速度阈值包括：AGV的机械结构极限速度、路径中各个路段的最大允许速度，和/或AGV的上位机指令速度；速度仲裁单元用于从基于路径长度的最大速度和预定速度阈值中选择最小速度作为行驶速度最大值。
可选地，运动驱动模块用于驱动AGV以预定加速度加速行驶，达到行驶速度最大值；驱动AGV以行驶速度最大值行驶至减速点；驱动AGV以预定减速度减速行驶直至静止。
这样的装置能够根据AGV需要行驶的路径的长度，以及AGV的减速度确定行程规划，使AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。
根据本发明的又一个方面，提出一种AGV，包括上文中提到的任意一项AGV运动控制装置；和，伺服放大器，用于接收来自AGV运动控制装置的控制信息，驱动AGV的轮系运动。
可选地，还包括轮系编码器，用于采集轮系的当前速度，并发送给AGV运动控制装置。
这样的AGV能够根据需要行驶的路径的长度，以及AGV的减速度确定行程规划，使AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。
根据本发明的再一个方面，提出一种AGV运动控制装置，包括：存储器；以及耦接至存储器的处理器，处理器被配置为基于存储在存储器的指令执行上文中提到的任意一种AGV运动控制方法。
这样的AGV运动控制装置能够利用存储在存储器中的指令，由处理器进行执行处理，根据AGV需要行驶的路径的长度，以及AGV的减速度确定行程规划，使AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。
另外，根据本发明的一个方面，提出一种计算机可读存储介质，其上存储有计算机程序指令，该指令被处理器执行时实现上文中提到的任意一种AGV运动控制方法的步骤。
这样计算机可读存储介质能够根据AGV需要行驶的路径的长度，以及AGV的减速度确定行程规划，使AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。
附图说明
此处所说明的附图用来提供对本发明的进一步理解，构成本申请的一部分，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：
图1为本发明的AGV运动控制方法的一个实施例的流程图。
图2为本发明的AGV运动控制方法中行程规划的一个实施例的流程图。
图3a为本发明的AGV运动控制方法中行程规划的一个实施例的示意图。
图3b为本发明的AGV运动控制方法中行程规划的另一个实施例的示意图。
图4为本发明的AGV运动控制方法的另一个实施例的流程图。
图5为本发明的AGV运动控制装置的一个实施例的示意图。
图6为本发明的AGV运动控制装置中行程规划模块的一个实施例的示意图。
图7为本发明的AGV的一个实施例的示意图。
图8为本发明的AGV的另一个实施例的示意图。
图9为本发明的AGV运动控制装置的又一个实施例的示意图。
图10为本发明的AGV运动控制装置的再一个实施例的示意图。
具体实施方式
下面通过附图和实施例，对本发明的技术方案做进一步的详细描述。
本发明的AGV运动控制方法的一个实施例的流程图如图1所示。
在步骤101中，根据路径长度和预定减速度确定AGV的行程规划。在一个实施例中，可以根据路径长度和车辆的减速度进行规划，设定符合行程长度的行驶速度、减速距离，生成行程规划。在一个实施例中，行程规划中可以包括行驶速度最大值和减速点，从而在保证AGV准确到达目的地的同时，尽量缩短时间，提高效率。
在步骤102中，根据行程规划驱动AGV运动。在一个实施例中，可以向AGV的轮系下达指令，控制轮系的速度变化。
通过这样的方法，能够根据AGV需要行驶的路径的长度，以及AGV的减速度确定行程规划，使AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。
本发明的AGV运动控制方法中行程规划的一个实施例的流程图如图2所示。
在步骤201中，根据路径长度、预定加速度和预定减速度确定基于路径长度的最大速度。在一个实施例中，可以在收到上位机发出的指令后进行计算。在一个实施例中，可以计算在整个路径长度中以预定加速度加速后再以预定减速度减速，在目的地达到静止状态，这一过程中能够达到的最大速度作为基于路径长度的最大速度。
在步骤202中，考虑到路径中不同路段的路况情况不同，以及车辆性能受限、上位机对生产节拍的控制等因素，可以设定预定速度阈值，根据基于路径长度的最大速度和预定速度阈值确定AGV的行驶速度最大值。在一个实施例中，预定速度阈值可以包括：AGV的机械结构极限速度、路径中各个路段的最大允许速度，AGV的上位机指令速度。可以从基于路径长度的最大速度和预定速度阈值中选择最小速度作为行驶速度最大值。
在步骤203中，根据行驶速度最大值和预定减速度确定减速点。在一个实施例中，减速点可以通过行驶距离表示，当AGV在路径中行驶达到行驶距离时，开始按照预定减速度减速；减速点还可以通过时长标识，当AGV行驶达到该时长时，开始按照预定减速度减速；减速点还可以通过速度表示，当AGV的速度达到该速度时，开始按照预定减速度减速。
通过这样的方法，能够在保证停车准确度的同时，提高行驶速度，提高作业效率；同时，充分考虑到AGV机械结构的限制、路径中不同路段的速度限制、上位机对AGV速度限制等因素，保证AGV的行驶速度符合各个方面的要求，保证AGV运行的安全。
在一个实施例中，如图3a所示，路径长度为S，可以将路径分为加速、减速两段，其中，在t1时间段内，AGV从当前速度Vcurrent加速到Vmax，预定加速度为aup，行驶的距离为S1；在t3时间段内，AGV从Vmax减速到0，到达目的地，预定减速度为adown，行驶的距离为S3，根据公式：
S＝S1+S3 (1)
S1＝0.5*aup*(Vmax-Vcurrent)2/aup 2+Vcurrent*(Vmax-Vcurrent)/aup (2)
S3＝0.5*adown*Vmax 2/adown 2 (3)
通过上述公式(1)(2)(3)可以得到：
Vmax＝(2*S*aup*adown+adown*Vcurrent 2)1/2/(aup+adown)1/2 (4)
通过这样的方法，能够得到基于路径长度的最大速度，在保证停车准确度的同时，提高行驶速度，提高作业效率。
在一个实施例中，AGV的行驶路径往往会有路径速度上限Vpath，Vmax不能够大于Vpath，否则容易发生事故，不利于维持自动物流设备的稳定性。在一个实施例中，可以通过公式计算以Vpath作为基于路径长度的最大速度时的加速长度S1和减速长度S3：
S1＝0.5*aup*(Vpath-Vcurrent)2/aup 2+Vcurrent*(Vpath-Vcurrent)/aup (5)
S3＝0.5*adown*Vpath 2/adown 2 (6)
若S1+S3＞S，则可以根据上述公式(4)得到Vmax。
若S1+S3≤S，则Vmax＝Vpath。当S1+S3＜S时，如图3b所示，AGV需要匀速行驶一段距离，匀速行驶长度S2＝S-S1-S3。
通过这样的方法，能够在路径速度上限Vpath的限制下确定基于路径长度的最大速度，保证停车准确度，提高行驶速度，提高作业效率，同时，能够提高物流自动化设备的稳定性和安全性。
本发明的AGV运动控制方法的另一个实施例的流程图如图4所示。
在步骤401中，根据路径长度和预定减速度确定AGV的行程规划。在一个实施例中，行程规划中可以包括行驶速度最大值和减速点。
在步骤402中，根据行程规划驱动AGV运动，可以包括驱动AGV以预定加速度加速行驶，达到行驶速度最大值；若未达到减速点，则驱动AGV以行驶速度最大值行驶至减速点；到达减速点后驱动AGV以预定减速度减速行驶直至静止。在一个实施例中，可以将控制信息发送给伺服放大器，由伺服放大器向轮系发送控制信息，驱动AGV运动。
通过这样的方法，能够控制AGV轮系的运动，保证AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。
在一个实施例中，还可以获取AGV的轮系的实时速度，一方面可以作为当前速度Vcurrent，供行程规划使用；另一方面能够监控AGV的行驶状态，提高对AGV的控制能力，便于对速度进行控制、调节。在一个实施例中，可以通过轮系编码器获取实时速度，从而提高实时速度的准确性。
本发明的AGV运动控制装置的一个实施例的示意图如图5所示。其中，行程规划模块501能够根据路径长度和预定减速度确定AGV的行程规划。在一个实施例中，可以根据路径长度和车辆的减速度进行规划，设定符合行程长度的行驶速度、减速距离，生成行程规划。在一个实施例中，行程规划中可以包括行驶速度最大值和减速点，从而在保证AGV准确到达目的地的同时，尽量缩短时间，提高效率。运动驱动模块502能够根据行程规划驱动AGV运动。在一个实施例中，可以向AGV的轮系下达指令，控制轮系的速度变化。
这样的装置能够根据AGV需要行驶的路径的长度，以及AGV的减速度确定行程规划，使AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。
本发明的AGV运动控制装置中行程规划模块的一个实施例的示意图如图6所示。其中，速度规划单元601能够根据路径长度、预定加速度和预定减速度确定基于路径长度的最大速度。在一个实施例中，可以计算在整个路径长度中以预定加速度加速后再以预定减速度减速，在目的地达到静止状态，这一过程中能够达到的最大速度作为基于路径长度的最大速度。速度仲裁单元602能够根据基于路径长度的最大速度和预定速度阈值确定AGV的行驶速度最大值。减速点确定单元603根据行驶速度最大值和预定减速度确定减速点。
这样的装置能够在保证停车准确度的同时，提高行驶速度，提高作业效率；同时，充分考虑到对AGV运行速度的限制，保证AGV的行驶速度符合各个方面的要求，保证AGV运行的安全。
在一个实施例中，速度规划单元601可以基于上文中的公式(4)得到基于路径长度的最大速度，从而在保证停车准确度的同时，提高行驶速度，提高作业效率；速度规划单元601还可以根据公式(4)～(6)确定在路径速度上限Vpath的限制下的基于路径长度的最大速度，保证停车准确度，提高行驶速度，提高作业效率，同时，能够提高物流自动化设备的稳定性和安全性。
在一个实施例中，考虑到路径中不同路段的路况情况不同，以及车辆性能受限、上位机对AGV调配过程中有速度要求等因素，设定的预定速度阈值可以包括：AGV的机械结构极限速度、路径中各个路段的最大允许速度，AGV的上位机指令速度。速度仲裁单元602可以从基于路径长度的最大速度和预定速度阈值中选择最小速度作为行驶速度最大值，从而充分考虑到AGV机械结构的限制、路径中不同路段的速度限制、上位机对AGV速度限制等因素，保证AGV的行驶速度符合各个方面的要求，保证AGV运行的安全。
在一个实施例中，减速点确定单元603确定的减速点可以通过行驶距离表示，当AGV在路径中行驶达到行驶距离时，开始按照预定减速度减速；减速点还可以通过时长标识，当AGV行驶达到该时长时，开始按照预定减速度减速；减速点还可以通过速度表示，当AGV的速度达到该速度时，开始按照预定减速度减速。这样的装置能够保证AGV到达减速点后即开始减速操作，保证AGV能够更加准确的停在目的地点，提高停车精度。
在一个实施例中，运动驱动模块502根据行程规划驱动AGV运动，可以包括驱动AGV以预定加速度加速行驶，达到行驶速度最大值；若未达到减速点，则驱动AGV以行驶速度最大值行驶至减速点；到达减速点后驱动AGV以预定减速度减速行驶直至静止。在一个实施例中，运动驱动模块502可以将控制信息发送给伺服放大器，由伺服放大器向轮系发送控制信息，驱动AGV运动。
这样的装置能够控制AGV轮系的运动，保证AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。
本发明的AGV的一个实施例的示意图如图7所示。其中，AGV运动控制装置701可以为上文中提到的任意一种AGV运动控制装置，能够生成基于AGV需要行驶的路径长度的行程规划，并将规划发送给伺服放大器702；伺服放大器702能够将从AGV运动控制装置701获取的控制信息发送给轮系，驱动AGV按照运动控制装置701生成的行程规划运动。
这样的AGV能够根据需要行驶的路径的长度，以及AGV的减速度确定行程规划，使AGV按照行程规划进行行驶，使AGV的行程更具针对性，保证AGV能够更加准确的停在目的地点，提高停车精度，且能够减少时间的浪费，提高作业效率，符合高速的作业节拍要求。通过实际测试，这样的AGV能够达到停车精度±2mm的效果。
本发明的AGV的另一个实施例的示意图如图8所示。其中，AGV运动控制装置801和伺服放大器802的结构和功能与图7的实施例中相似。AGV还包括轮系编码器803，能够获取AGV的轮系的实时速度，并发送给AGV运动控制装置801，一方面可以作为当前速度Vcurrent，供行程规划使用；另一方面能够监控AGV的行驶状态，提高对AGV的控制能力，便于对速度进行控制和调整。
本发明AGV运动控制装置的另一个实施例的结构示意图如图9所示。AGV运动控制装置包括存储器910和处理器920。其中：存储器910可以是磁盘、闪存或其它任何非易失性存储介质。存储器用于存储物品三维重建方法的对应实施例中的指令。处理器920耦接至存储器910，可以作为一个或多个集成电路来实施，例如微处理器或微控制器。该处理器920用于执行存储器中存储的指令，能够实现对AGV的运动规划和运动驱动。
在一个实施例中，还可以如图10所示，AGV运动控制装置1000包括存储器1010和处理器1020。处理器1020通过BUS总线1030耦合至存储器1010。该AGV运动控制装置1000还可以通过存储接口1040连接至外部存储装置1050以便调用外部数据，还可以通过网络接口1060连接至网络或者另外一台计算机系统(未标出)。此处不再进行详细介绍。
在该实施例中，通过存储器存储数据指令，再通过处理器处理上述指令，能够实现对AGV的运动规划和运动驱动。
在另一个实施例中，一种计算机可读存储介质，其上存储有计算机程序指令，该指令被处理器执行时实现物品三维重建方法的对应实施例中的方法的步骤。本领域内的技术人员应明白，本发明的实施例可提供为方法、装置、或计算机程序产品。因此，本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用非瞬时性存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明是参照根据本发明实施例的方法、设备(系统)和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
至此，已经详细描述了本发明。为了避免遮蔽本发明的构思，没有描述本领域所公知的一些细节。本领域技术人员根据上面的描述，完全可以明白如何实施这里公开的技术方案。
可能以许多方式来实现本发明的方法以及装置。例如，可通过软件、硬件、固件或者软件、硬件、固件的任何组合来实现本发明的方法以及装置。用于所述方法的步骤的上述顺序仅是为了进行说明，本发明的方法的步骤不限于以上具体描述的顺序，除非以其它方式特别说明。此外，在一些实施例中，还可将本发明实施为记录在记录介质中的程序，这些程序包括用于实现根据本发明的方法的机器可读指令。因而，本发明还覆盖存储用于执行根据本发明的方法的程序的记录介质。
最后应当说明的是：以上实施例仅用以说明本发明的技术方案而非对其限制；尽管参照较佳实施例对本发明进行了详细的说明，所属领域的普通技术人员应当理解：依然可以对本发明的具体实施方式进行修改或者对部分技术特征进行等同替换；而不脱离本发明技术方案的精神，其均应涵盖在本发明请求保护的技术方案范围当中。

Claims (14)

1.一种自动引导运输车AGV运动控制方法，其特征在于，包括：
根据路径长度和预定减速度确定AGV的行程规划，所述行程规划中包括行驶速度最大值和减速点，包括：
根据路径长度、所述AGV的当前速度、预定加速度和预定减速度确定基于路径长度的最大速度，包括：根据公式
Vmax＝(2*S*aup*adown+adown*Vcurrent 2)1/2/(aup+adown)1/2；
确定能够保证所述AGV停止在目的地点的行程能够达到的最大速度Vmax，其中，Vcurrent为当前速度，S为路径长度，aup为预定加速度，预定减速度为adown；
根据所述基于路径长度的最大速度和预定速度阈值确定所述AGV的行驶速度最大值；
根据所述行驶速度最大值和所述预定减速度确定所述减速点，其中，所述当前速度不为0；
根据所述行程规划驱动所述AGV运动。
2.根据权利要求1所述的方法，其特征在于，所述根据路径长度、预定加速度和预定减速度确定基于路径长度的最大速度还包括：
根据所述预定加速度确定所述AGV从当前速度加速到路径速度上限需要行驶的加速长度；
根据所述预定减速度确定所述AGV从所述路径速度上限减速到静止状态需要行驶的减速长度；
若所述加速长度与所述减速长度之和不大于所述路径长度，则确定所述基于路径长度的最大速度为所述路径速度上限；
若所述加速长度与所述减速长度之和大于所述路径长度，则确定能够保证所述AGV停止在目的地点的行程能够达到的最大速度作为所述基于路径长度的最大速度。
3.根据权利要求1所述的方法，其特征在于，所述预定速度阈值包括：AGV的机械结构极限速度、路径中各个路段的最大允许速度，和/或所述AGV的上位机指令速度；
所述根据所述基于路径长度的最大速度和预定速度阈值确定所述AGV的行驶速度最大值包括：
从所述基于路径长度的最大速度和所述预定速度阈值中选择最小速度作为所述行驶速度最大值。
4.根据权利要求1所述的方法，其特征在于，所述根据所述行程规划驱动所述AGV运动包括：
驱动所述AGV以所述预定加速度加速行驶，达到所述行驶速度最大值；
驱动所述AGV以所述行驶速度最大值行驶至所述减速点；
驱动所述AGV以所述预定减速度减速行驶直至静止。
5.根据权利要求1所述的方法，其特征在于，还包括：
获取所述AGV的轮系的实时速度。
6.根据权利要求1所述的方法，其特征在于，所述根据所述行程规划驱动所述AGV运动包括：
通过伺服放大器向轮系发送控制信息，驱动所述AGV运动。
7.一种自动引导运输车AGV运动控制装置，其特征在于，包括：
行程规划模块，用于根据路径长度和预定减速度确定AGV的行程规划，所述行程规划中包括行驶速度最大值和减速点，包括：
速度规划单元，用于根据路径长度、所述AGV的当前速度、预定加速度和预定减速度确定基于路径长度的最大速度，包括：
根据公式
Vmax＝(2*S*aup*adown+adown*Vcurrent 2)1/2/(aup+adown)1/2；
确定能够保证所述AGV停止在目的地点的行程能够达到的最大速度Vmax，其中，Vcurrent为当前速度，S为路径长度，aup为预定加速度，预定减速度为adown；
其中，所述当前速度不为0；
速度仲裁单元，用于根据所述基于路径长度的最大速度和预定速度阈值确定所述AGV的行驶速度最大值；
减速点确定单元，用于根据所述行驶速度最大值和所述预定减速度确定所述减速点；
运动驱动模块，用于根据所述行程规划驱动所述AGV运动。
8.根据权利要求7所述的装置，其特征在于，所述速度规划单元用于：
根据所述预定加速度确定所述AGV从当前速度加速到路径速度上限需要行驶的加速长度；
根据所述预定减速度确定所述AGV从所述路径速度上限减速到静止状态需要行驶的减速长度；
若所述加速长度与所述减速长度之和不大于所述路径长度，则确定所述基于路径长度的最大速度为所述路径速度上限；
若所述加速长度与所述减速长度之和大于所述路径长度，则确定能够保证所述AGV停止在目的地点的行程能够达到的最大速度作为所述基于路径长度的最大速度。
9.根据权利要求7所述的装置，其特征在于，所述预定速度阈值包括：AGV的机械结构极限速度、路径中各个路段的最大允许速度，和/或所述AGV的上位机指令速度；
所述速度仲裁单元用于从所述基于路径长度的最大速度和所述预定速度阈值中选择最小速度作为所述行驶速度最大值。
10.根据权利要求7所述的装置，其特征在于，所述运动驱动模块用于驱动所述AGV以所述预定加速度加速行驶，达到所述行驶速度最大值；驱动所述AGV以所述行驶速度最大值行驶至所述减速点；驱动所述AGV以所述预定减速度减速行驶直至静止。
11.一种自动引导运输车AGV，其特征在于，包括权利要求7～10任一所述AGV运动控制装置；和，
伺服放大器，用于接收来自所述AGV运动控制装置的控制信息，驱动所述AGV的轮系运动。
12.根据权利要求11所述的AGV，其特征在于，还包括轮系编码器，用于采集所述轮系的当前速度，并发送给所述AGV运动控制装置。
13.一种自动引导运输车AGV运动控制装置，其特征在于，包括：
存储器；以及
耦接至所述存储器的处理器，所述处理器被配置为基于存储在所述存储器的指令执行如权利要求1至6任意一项所述的方法。
14.一种计算机可读存储介质，其上存储有计算机程序指令，其特征在于，该指令被处理器执行时实现权利要求1至6任意一项所述的方法的步骤。
CN201610901977.XA 2016-10-18 2016-10-18 自动引导运输车agv及运动控制方法和装置 Active CN106444762B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201610901977.XA CN106444762B (zh) 2016-10-18 2016-10-18 自动引导运输车agv及运动控制方法和装置
PCT/CN2017/105799 WO2018072635A1 (zh) 2016-10-18 2017-10-12 自动引导运输车agv及运动控制方法和装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610901977.XA CN106444762B (zh) 2016-10-18 2016-10-18 自动引导运输车agv及运动控制方法和装置

Publications (2)

Publication Number Publication Date
CN106444762A CN106444762A (zh) 2017-02-22
CN106444762B true CN106444762B (zh) 2020-03-03

Family

ID=58175120

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610901977.XA Active CN106444762B (zh) 2016-10-18 2016-10-18 自动引导运输车agv及运动控制方法和装置

Country Status (2)

Country Link
CN (1) CN106444762B (zh)
WO (1) WO2018072635A1 (zh)

Families Citing this family (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106444762B (zh) * 2016-10-18 2020-03-03 天津京东深拓机器人科技有限公司 自动引导运输车agv及运动控制方法和装置
CN107102641B (zh) * 2017-05-18 2020-08-07 湖北工业大学 一种基于激光引导双轮差速agv的原地偏航旋转方法
CN108445893A (zh) * 2018-06-07 2018-08-24 浙江国自机器人技术有限公司 一种移动机器人控制器及移动机器人
CN109190185A (zh) * 2018-08-10 2019-01-11 安徽库讯自动化设备有限公司 一种具有参数分析功能的agv小车的运行状态调控方法
CN109165830A (zh) * 2018-08-10 2019-01-08 安徽库讯自动化设备有限公司 一种agv小车运行状态的智能化调控系统
CN111105177B (zh) * 2018-10-26 2023-04-18 菜鸟智能物流控股有限公司 物流对象的管理方法、装置、设备、系统和存储介质
CN109597413A (zh) * 2018-12-06 2019-04-09 南京华苏科技有限公司 一种基于rfid的产品测试的智能化管理方法
CN109885070B (zh) * 2019-04-01 2020-12-18 上海快仓智能科技有限公司 机器人的运动控制方法、运动控制设备以及自动仓储系统
CN110194343A (zh) * 2019-05-17 2019-09-03 盐城品迅智能科技服务有限公司 一种多agv智能仓储密集架的通信系统及货物搬运方法
CN111760795B (zh) * 2019-07-16 2022-02-01 北京京东乾石科技有限公司 用于分拣货物的方法和装置
CN110488826B (zh) * 2019-08-20 2022-09-20 集美大学 一种适于路径冲突的agv避碰方法、终端设备及存储介质
CN111290397B (zh) * 2020-03-12 2023-08-25 三一机器人科技有限公司 速度调节方法、装置、自动导航车及存储介质
CN111813127A (zh) * 2020-07-28 2020-10-23 丹阳市安悦信息技术有限公司 一种自动驾驶式的汽车搬运机器人系统
CN112327863A (zh) * 2020-11-17 2021-02-05 中车资阳机车有限公司 一种对位牵引车辅助定位控制方法
CN112734092B (zh) * 2020-12-30 2023-07-18 驭势科技（北京）有限公司 一种校准方法、装置、设备及存储介质
CN113751330B (zh) * 2021-01-18 2023-06-23 北京京东乾石科技有限公司 物品分拣方法、系统、设备和存储介质
CN113716495A (zh) * 2021-09-02 2021-11-30 衡阳宝坤机械制造有限公司 一种智能化仓储叉车控制系统
CN114035623A (zh) * 2021-09-23 2022-02-11 西门子工厂自动化工程有限公司 设备往复运动的控制方法、装置和计算机可读介质
CN114137978A (zh) * 2021-11-29 2022-03-04 佛山市毕佳索智能科技有限公司 一种仓储agv的速度规划与控制方法
CN114326710B (zh) * 2021-12-04 2024-05-24 深圳市普渡科技有限公司 机器人、机器人行驶策略确定方法、装置和存储介质
CN115005714B (zh) * 2022-06-22 2023-01-03 宁波国琅机器人科技有限公司 一种扫地机器人控制方法、系统、存储介质及智能终端

Family Cites Families (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS613211A (ja) * 1984-06-15 1986-01-09 Hitachi Kiden Kogyo Ltd 無人搬送車に於ける絶対番地読取り方法
KR100478451B1 (ko) * 2002-07-05 2005-03-22 삼성전자주식회사 무인반송 시스템의 제어방법
KR20050035739A (ko) * 2003-10-14 2005-04-19 삼성전자주식회사 무인반송차 제어시스템 및 그 제어방법
CN102269595A (zh) * 2010-06-02 2011-12-07 东北大学 基于导航线识别的嵌入式单目视觉导航系统
WO2013033179A1 (en) * 2011-08-29 2013-03-07 Crown Equipment Corporation Vehicular navigation control interface
JP2013168012A (ja) * 2012-02-15 2013-08-29 Murata Mach Ltd 走行車システム
CN104089623A (zh) * 2014-07-14 2014-10-08 上海海事大学 一种用于运载车行驶状态及路径的生成系统及方法
CN104182777B (zh) * 2014-08-13 2017-05-03 成都四威高科技产业园有限公司 一种基于rfid的agv多任务定位方法
CN104298114A (zh) * 2014-10-29 2015-01-21 西南科技大学 自适应鲁棒s型速度规划算法
CN104731107B (zh) * 2015-03-26 2017-12-05 北京特种机械研究所 一种电动六自由度运动平台高精度控制系统及控制方法
CN105082135B (zh) * 2015-09-11 2016-11-30 东南大学 一种机器人点动操作的速度控制方法
CN105388899B (zh) * 2015-12-17 2018-01-16 中国科学院合肥物质科学研究院 一种基于二维码图像标签的agv导航控制方法
CN105867376B (zh) * 2016-04-12 2018-10-23 南京工程学院 基于三角函数的工业机器人轨迹规划升降速控制方法
CN105739505B (zh) * 2016-04-13 2018-09-04 上海物景智能科技有限公司 一种机器人的路径控制方法及系统
CN105739506A (zh) * 2016-04-26 2016-07-06 昆山易捷联控制系统研发科技有限公司 智能运载机器人的自主导航方法
CN106444762B (zh) * 2016-10-18 2020-03-03 天津京东深拓机器人科技有限公司 自动引导运输车agv及运动控制方法和装置

Also Published As

Publication number Publication date
CN106444762A (zh) 2017-02-22
WO2018072635A1 (zh) 2018-04-26

Similar Documents

Publication Publication Date Title
CN106444762B (zh) 自动引导运输车agv及运动控制方法和装置
CN110347167B (zh) 一种速度规划方法及速度规划系统
US10471960B2 (en) Adaptive cruise control apparatus and method of operating adaptive cruise control in consideration of traffic condition
CN109466554A (zh) 自适应巡航加塞预防控制方法、系统、装置和存储介质
JP6337435B2 (ja) 運転支援装置
JP6087805B2 (ja) 運転曲線作成装置、運転支援装置、運転制御装置および運転曲線作成方法
RU2017111581A (ru) Устройство управления движением транспортного средства
CN109070765A (zh) 列车控制装置、方法以及程序
KR102528317B1 (ko) 차량 제어용 컨트롤러, 시스템 및 방법
CN108983787B (zh) 道路行驶方法
WO2019233081A1 (zh) 一种自动驾驶方法及装置
CN111474930A (zh) 一种基于视觉定位的循迹控制方法、装置、设备及介质
JP2017063556A5 (zh)
JP2017126199A (ja) ブロック時間表示手段を有する数値制御装置
CN112572461A (zh) 控制车辆的方法、装置、设备和存储介质
US20190077460A1 (en) Method and device for operating a motor vehicle traveling driverlessly within a parking facility
JP2014047022A (ja) 移動体の制御方法
CN110647146B (zh) 无人车控制方法、装置、计算机设备和存储介质
CN111114594B (zh) 轨道列车辅助驾驶控制方法、装置和列车
JP2008005585A (ja) 車両制御システム
JPWO2020178608A5 (zh)
CN114167857B (zh) 一种无人驾驶设备的控制方法及装置
JP2016032359A (ja) 列車制御装置
CN114291138A (zh) 一种列车自动运行规划控制方法及相关装置
KR101363358B1 (ko) 로봇의 제어 시스템 및 그 방법

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right

Effective date of registration: 20190730

Address after: 300 457 days First Floor, Phase 2, No. 10, Fourth Avenue, Binhai New Area Economic and Technological Development Zone, Tianjin

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
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20200527

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

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

Address before: 300 457 days First Floor, Phase 2, No. 10, Fourth Avenue, Binhai New Area Economic and Technological Development Zone, Tianjin

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

TR01 Transfer of patent right