CN108983762A - 自动导引运输车的控制方法、装置及自动导引运输车 - Google Patents

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

Info

Publication number
CN108983762A
CN108983762A CN201710408256.XA CN201710408256A CN108983762A CN 108983762 A CN108983762 A CN 108983762A CN 201710408256 A CN201710408256 A CN 201710408256A CN 108983762 A CN108983762 A CN 108983762A
Authority
CN
China
Prior art keywords
driving wheel
speed
sampling instant
guided vehicle
automated guided
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
CN201710408256.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 CN201710408256.XA priority Critical patent/CN108983762A/zh
Publication of CN108983762A publication Critical patent/CN108983762A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0242Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • G05D1/0253Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0259Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/028Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2201/00Application
    • G05D2201/02Control of position of land vehicles
    • G05D2201/0216Vehicle for transporting goods in a warehouse, factory or similar

Abstract

本申请公开了自动导引运输车的控制方法、装置及自动导引运输车。该方法的一具体实施方式包括:对第K个采样时刻采集到的各驱动轮的第一运行速度滤波,得到第K个采样时刻各驱动轮的第一有效运行速度;获取第K个采样时刻与第K‑1个采样时刻期间各驱动轮的行进距离和自动导引运输车的行进距离;基于各驱动轮的行进距离和自动导引运输车的行进距离修正各驱动轮的预设运行速度指令值;基于第K个采样时刻各驱动轮的第一有效运行速度与修正后的预设运行速度指令值确定各驱动轮电机的转速。该实施方式在每个运行周期矫正采集到的驱动轮运行速度,从而改善了由于驱动轮速度测量误差积累导致的自动导引运输车跑偏的现象。

Description

自动导引运输车的控制方法、装置及自动导引运输车
技术领域
[0001] 本申请涉及计算机技术领域,具体涉及控制技术领域,尤其涉及自动导引运输车 的控制方法、装置及自动导引运输车。
背景技术
[0002] 自动导引运输车(Automated Guided Vehicle,AGV)是一种以电池为动力、装有非 接触导向装置和独立寻址系统的无人驾驶自动化搬运车辆,其在计算机的监控下,按指令 自主驾驶,自动沿着规定的导引路径行驶到达指定地点,并完成一系列作业任务。
[0003] 目前,通常由运动控制器根据直接采集到的AGV驱动轮的运行速度和驱动轮的运 行距离来调整AGV行进速度和位置。
[0004] 但是,在异常路段如打滑路段中,采集到的AGV驱动轮的运行速度异常增大或减 小;或者,采样系统故障时,将导致驱动轮运行速度采样值异常增大或减小。采用现有的方 式来调整AGV行进速度和位置时,运动控制器将随之减小驱动轮的运行速度指令值或增大 驱动轮的运行速度指令值,这样就会使得驱动轮异常降速或异常增速。通过以上分析可以 看出,现有技术中,正是由于运动控制器将异常速度采集值引入,形成一种正反馈机制,导 致AGV跑偏甚至飞车。
发明内容
[0005] 本申请实施例的目的在于提出一种改进的自动导引运输车的控制方法、装置及自 动导引运输车,来解决以上背景技术部分提到的技术问题。
[0006] 第一方面,本申请实施例提供了一种自动导引运输车的控制方法,该方法包括:对 第K个采样时刻采集到的各驱动轮的第一运行速度滤波,得到第K个采样时刻各驱动轮的第 一有效运行速度;获取第K个采样时刻与第K-I个采样时刻期间各驱动轮的行进距离和自动 导引运输车的行进距离;基于各驱动轮的行进距离和自动导引运输车的行进距离修正各驱 动轮的预设运行速度指令值;基于第K个采样时刻各驱动轮的第一有效运行速度与修正后 的预设运行速度指令值确定各驱动轮电机的转速;其中,驱动轮行进距离由驱动轮自第K-I 个采样时刻至第K个采样时刻期间转动的次数确定,自动导引运输车的行进距离由自动导 引运输车在第K个采样时刻的位姿信息与第K-I个采样时刻的位姿信息确定;K多1,且K为正 整数。
[0007] 第二方面,本申请实施例提供了一种自动导引运输车的控制装置,该装置包括:滤 波单元,配置用于对第K个采样时刻采集到的各驱动轮的第一运行速度滤波,得到所述第K 个采样时刻各所述驱动轮的第一有效运行速度;获取单元,配置用于获取所述第K个采样时 刻与第K-I个采样时刻期间各驱动轮的行进距离和所述自动导引运输车的行进距离;修正 单元,配置用于基于所述各驱动轮的行进距离和所述自动导引运输车的行进距离修正各所 述驱动轮的预设运行速度指令值;第一确定单元,配置用于基于第K个采样时刻各所述驱动 轮的第一有效运行速度与修正后的预设运行速度指令值确定各驱动轮电机的转速;其中, 所述驱动轮的行进距离由所述驱动轮自所述第K-I个采样时刻至第K个采样时刻期间转动 的次数确定,所述自动导引运输车的行进距离由所述自动导引运输车在第K个采样时刻的 位姿信息与第K-I个采样时刻的位姿信息确定;K多1,且K为正整数。
[0008]第三方面,本申请实施例提供了一种自动导运输车,自动导引运输车包括:一个或 多个处理器;存储装置,用于存储一个或多个程序;当一个或多个程序被一个或多个处理器 执行,使得一个或多个处理器实现如上述的方法。
[0009] 本申请实施例提供的自动导引运输车的控制方法、装置及自动导引运输车,通过 对第K个采样时刻采集到的各驱动轮的第一运行速度滤波,得到第K个采样时刻各驱动轮的 第一有效运行速度;然后获取第K个采样时刻与第K-I个采样时刻期间各驱动轮的行进距离 和自动导引运输车的行进距离;而后基于各驱动轮的行进距离和自动导引运输车的行进距 离修正各驱动轮的预设运行速度指令值;最后基于第K个采样时刻各驱动轮的第一有效运 行速度与修正后的预设运行速度指令值确定各驱动轮电机的转速。本申请实施例提供的自 动导引运输车的方法,在自动导引运输车的每个运行周期对采集到的驱动轮运行速度进行 矫正,并根据驱动轮行驶距离与自动导引运输车的行驶距离修正驱动轮的运行速度指令 值,从而改善了由于驱动轮速度测量误差积累导致的自动导引运输车跑偏的现象。
[0010] 此外,采用本实施例提供的方法,不需要额外增加硬件设备以及繁复的场景参数 配置,可以降低自动导引运输车系统的调试难度,有利于自动导引运输车的推广。
附图说明
[0011] 通过阅读参照以下附图所作的对非限制性实施例所作的详细描述,本申请的其它 特征、目的和优点将会变得更明显:
[0012] 图1是本申请可以应用于其中的示例性系统架构图;
[0013] 图2是根据本申请的自动导引运输车的控制方法的一个实施例的流程图;
[0014] 图3是图2的流程图中步骤201的一个分解流程示意图;
[0015]图4是图2所示流程图中步骤203的一个分解流程示意图;
[0016]图5是对图2的流程图中步骤204的一个分解流程示意图;
[0017]图6是根据本申请的根据本申请的自动导引运输车的控制方法的一个原理性示意 图;
[0018] 图7是根据本申请的自动导引运输车的控制装置的一个实施例的结构示意图;
[0019] 图8是适于用来实现本申请实施例的自动导引运输车的一个实施例的结构示意 图。
具体实施方式
[0020] 下面结合附图和实施例对本申请作进一步的详细说明。可以理解的是,此处所描 述的具体实施例仅仅用于解释相关发明,而非对该发明的限定。另外还需要说明的是,为了 便于描述,附图中仅示出了与有关发明相关的部分。
[0021] 需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相 互组合。下面将参考附图并结合实施例来详细说明本申请。
[0022] 图1示出了可以应用本申请的自动导引运输车的控制方法或自动导引运输车的控 制装置的示例性系统架构100。
[0023] 如图1所示,系统架构100可以包括自动导引运输车101、网络102和对自动导引运 输车101提供支持的服务器103。自动导引运输车101中可以设置有车载智能设备104。网络 102用以在自动导引运输车101和服务器103之间提供通信链路的介质。网络102可以包括各 种连接类型,例如有线、无线通信链路或者光纤电缆等等。
[0024] 车载智能设备104上安装有自动导引运输车101的控制系统。控制系统可以控制自 动导引运输车101的运行。车载智能设备104也可以通过网络102与服务器103交互,以接收 控制指令(例如运行指令)等信息。
[0025] 自动导引运输车101上还可以安装有各种传感器,例如障碍物传感器、摄像装置、 陀螺仪、加速计等。在各驱动轮中可以安装有车轮转速测量传感器,利用车轮转速测量传感 器发出的信号可以计算自动导引运输车的驱动轮的行进距离以及在任意一个采样时刻的 运行速度等。需要说明的是,自动导引运输车101还可以安装有除上述列举外的各种类型和 功能的传感器,在此不再赘述。
[0026] 服务器103可以是提供各种服务的服务器,例如对自动导引运输车101进行管理并 分配任务的管理服务器,管理服务器可以向车载智能设备104发送运行指令等信息,以使车 载智能设备104对自动导引运输车101进行控制。
[0027] 需要指出的是,上述运行指令也可以在自动导引运输车101所安装的传感器检测 到某一信号时自动触发,此时,上述系统架构100可以不存在网络102和服务器103。
[0028] 需要说明的是,本申请实施例所提供的自动导引运输车的控制方法一般由车载智 能设备104执行,相应地,自动导引运输车的控制装置一般设置于车载智能设备104中。
[0029] 应该理解,图1中的自动导引运输车、车载智能设备、网络和服务器的数目仅仅是 示意性的。根据实现需要,可以具有任意数目的自动导引运输车、车载智能设备、网络和服 务器。
[0030] 继续参考图2,示出了根据本申请的自动导引运输车的控制方法的一个实施例的 流程200。自动导引运输车的控制方法,包括以下步骤:
[0031] 步骤201,对第K个采样时刻采集到的各驱动轮的第一运行速度滤波,得到第K个采 样时刻各驱动轮的第一有效运行速度。
[0032] 在本实施例中,自动导引运输车的控制方法运行于其上的电子设备(例如图1所示 的车载智能设备104)可以通过有线连接方式或者无线连接方式从服务器(例如图1所示的 服务器103)接收对自动导引运输车(例如图1所示的自动导引运输车101)发出的运行指令, 其中,上述运行指令可以用于指示上述电子设备控制上述自动导引运输车即将前往的目标 位置。
[0033] 实践中,上述自动导引运输车在上述电子设备接收到上述运行指令前,可以静止 在任意预设的位置。可以将自动导引运输车静止时的位置作为初始位置。
[0034] 上述电子设备可以预先获取上述自动导引运输车在初始位置时的位姿信息。在一 些应用场景中,电子设备可以将初始位置时的位姿信息通过有线连接方式或者无线连接方 式送给服务器(例如图1所示的服务器103)。
[0035] 需要指出的是,上述无线连接方式可以包括但不限于3G/4G连接、WiFi连接、蓝牙 连接、WiMAX连接、Zigbee连接、UWB (ultra wideband)连接、以及其他现在已知或将来开发 的无线连接方式。
[0036] 此外,上述初始位置和目标位置例如可以具体表示为自动导引运输车在预先建立 的坐标系中的坐标。
[0037] 在一些应用场景中,上述电子设备在将静止在该位置时的位姿信息发送给服务器 之后,服务器可以从上述位姿信息中提取出初始位置的坐标信息。并根据上述自动导引运 输车初始位置的坐标以及目标位置的坐标为自动导引运输车规划行驶路径(例如可以按照 运行路程最短的原则来规划行驶路径)。在规划好行驶路径之后,服务器将该行驶路径发送 给电子设备。电子设备在接收到服务器发送的规划路径之后存储该规划路径,并按照上述 规划路径生成控制信号控制自动导引运输车运行。
[0038] 在另外一些应用场景中,上述电子设备在接收到服务器发送的目的地址之后,根 据自动导引运输车的初始位置坐标以及目标位置坐标调用预先存储于电子设备中的路径 规划算法来规划行驶路径。同时电子设备生成控制信号控制自动导引运输车按照规划行驶 路径运行。
[0039] 上述规划行驶路径可以包括N个路段,每一个路段均可以包括起始点和终止点。任 意一个路段的起始点可以是其上一个路段的终止点。任意一个路段的终止点可以是其下一 个路段的终止点。其中,N彡1,且N为正整数。
[0040] 在本实施例中,每一个路段可以对应自动导引运输车的一个运行周期。在每个自 动导引运输车的运行周期电子设备通过控制信号对自动导引运输车的驱动系统进行控制。 每一个运行周期例如可以包括起始时间及终止时间。每一个运行周期例如可以包括至少一 个采样时刻。
[0041] 自动导引运输车的驱动系统可以包括驱动电机。驱动系统可以接收来自上述电子 设备的控制信号,通过控制信号控制驱动电机的转速来达到控制自动导引运输车的驱动轮 的转速以控制自动导引运输车的运行及转向等。
[0042] 在本实施例中,自动导引运输车可以包括多个驱动轮。此外,每一个驱动轮中可以 对应安装车轮转速测量传感器(例如霍尔传感器,或者光电传感器)。
[0043] 对每一个驱动轮而言,驱动轮每转动预定角度(预定角度例如可以为360°),安装 于驱动轮之内的车轮转速测量传感器可以发出一个脉冲信号。在一些应用场景中,上述脉 冲信号可通过导线被传送到上述电子设备。电子设备通过统计采样时刻持续时间TO由车轮 转速测量传感器发出的脉冲信号的个数,可以得知驱动轮在采样时刻持续时间TO内的转数 Ml。可以通过公式(1)和公式(2)分别得到采样时刻持续时间TO驱动轮的转速ω (即角速度) 以及驱动轮在采样期间TO的第一运行速度V:
Figure CN108983762AD00081
[0044]
[0045]
[0046] 其中,R是驱动轮的半径。
[0047] 在本实施例中,可以采用上述方法在第K个采样时刻采集各驱动轮的第一运行速 度。此处,K可以大于等于1,且K为正整数。进一步地,K可以小于等于Ν。
[0048] 可以假定在每一个运行周期内,驱动轮匀速行驶,在上述在第K个采样时刻采集到 的各驱动轮的第一运行速度也即各驱动轮在第K个运行周期内的第一运行速度。
[0049] 接着上述电子设备可以对在第K个采样时刻采集到的各驱动轮的第一运行速度进 行滤波,得到第K个采样时刻各驱动轮的第一有效运行速度。
[0050] 在本实施例中,可以使用各种方法对各驱动轮的第一有效运行速度进行滤波,例 如使用限幅滤波方法对各驱动轮的第一运行速度进行滤波,以得到第K个采样时刻各驱动 轮的第一有效运行速度。
[0051] 步骤202,获取第K个采样时刻与第K-I个采样时刻期间各驱动轮的行进距离和自 动导引运输车的行进距离。
[0052] 在本实施例中,可以通过计算安装于各驱动轮之上的车轮转速测量传感器自第Κ-ΐ 个采样时刻至第 K 个采样时刻期间 Tl 发出的脉冲信号的个数来计算各驱动轮的转数 M1,并 通过公式⑶得到各驱动轮自第K-I个采样时刻至第K个采样时刻期间Tl的行进距离Sk1 :
[0053] Ski=Ml X 2JT X R ⑶
[0054] 此外,上述电子设备还可以实时获取自动导引运输车所处的位置信息。例如电子 设备可以根据预先安装在其上的全球定位系统来实时获取自动导引运输车的位姿信息。上 述位姿信息例如可以包括自动导引运输车的坐标信息。自动导引运输车可以根据第K个采 样时刻自动导引运输车所处的位置的坐标以及第K-I个采样时刻期间所处位置的坐标来得 到第K个采样时刻与第K-I个采样时刻期间Tl自动导引运输车的行进距离。
[0055] 步骤203,基于各驱动轮的行进距离和自动导引运输车的行进距离修正各驱动轮 的预设运行速度指令值。
[0056] 在本实施例中,上述电子设备可以根据规划行驶路径中每个路段对应的路程,以 及自动导引运输车经过每个路段所用的时间对自动导引运输车的各驱动轮预先设定对应 每个运行周期的运行速度指令值。
[0057] 在本实施例中,当自动导引运输车处于与第K个采样时刻对应的第K个路段时,电 子设备可以基于各驱动轮的行进距离和自动导引运输车的行进距离修正各驱动轮的预设 运行速度指令值。
[0058] 步骤204,基于第K个采样时刻各驱动轮的第一有效运行速度与修正后的预设运行 速度指令值确定各驱动轮电机的转速。
[0059] 在本实施例中,在步骤201中得到各驱动轮的第一有效运行速度以及在步骤203中 得到修正的各驱动轮的预设运行速度指令值之后,电子设备可以基于第K个采样时刻各驱 动轮的第一有效运行速度与修正后的预设运行速度指令值确定各驱动轮电机的转速,以使 各驱动轮的转速趋近各自的修正后的预设运行速度指令值。
[0060] 在本实施例中,通过对第K个采样时刻采集到的各驱动轮的第一运行速度滤波,得 到第K个采样时刻各驱动轮的第一有效运行速度;然后获取第K个采样时刻与第K-I个采样 时刻期间各驱动轮的行进距离和自动导引运输车的行进距离;而后基于各驱动轮行进距离 和自动导引运输车的行进距离修正各驱动轮的预设运行速度指令值;最后基于第K个采样 时刻各驱动轮的第一有效运行速度与修正后的预设运行速度指令值确定各驱动轮电机的 转速。本申请实施例提供的自动导引运输车的方法,在自动导引运输车的每个运行周期对 采集到的驱动轮运行速度进行矫正,并根据驱动轮行驶距离与自动导引运输车的行驶距离 修正驱动轮的运行速度指令值,从而改善了由于驱动轮速度测量误差积累导致的自动导引 运输车跑偏的现象。此外,采用本实施例提供的方法,不需要额外增加硬件设备以及繁复的 场景参数配置,可以降低自动导引运输车系统的调试难度,有利于自动导引运输车的推广。
[0061] 在本实施例的一些可选实现方式中,请参考图3,其示出了图2的流程图中步骤201 的一个分解流程示意图300。如图3所示,图2中的步骤201可以包括如下子步骤:
[0062] 子步骤2011,获取与第K个采样时刻关联的各驱动轮的增速极限值、各驱动轮的预 设运行速度指令值以及第K-I个采样时刻的各驱动轮的第一有效运行速度。
[0063] 在本实施例中,与第K个采样时刻关联的各驱动轮的增速极限值例如可以为第K个 运行周期的各驱动轮的增速极限值,也就是自动导引运输车在规划路径上的第K个路段的 上运行时可以达到的增速极限值。
[0064] 在一些应用场景中,上述电子设备可以预先为第K个运行周期设定一个固定加速 度aK。此外,电子设备预先为第K个运行周期分配的时间也即第K个运行周期所用时间为Τκ, 上述与第K个采样时刻关联的各驱动轮的增速极限值Δ νκ可以通过公式⑷得到:
[0065] Δ Vk = BkXTk ⑷。
[0066] 此外,电子设备可以预先为第K个运行周期设定运行速度指令值,也就是在第K个 运行周期自动导引运输车的预设运行速度指令值。
[0067] 此外,电子设备中还可以存储第K-I个运行周期的第一有效运行速度。
[0068] 当K = I时,第K-I个运行周期的第一有效运行速度为零。
[0069] 这样电子设备可以通过预先为第K个运行周期设定的加速度指令值、第K个运行周 期所用时间来计算与第K个采样时刻关联的、各驱动轮的增速极限值。另外还可以读取预设 的与第K个采样时刻关联的、各驱动轮预设运行速度指令值以及存储的第K-I个采样时刻的 各驱动轮的第一有效运行速度。
[0070] 子步骤2012,判断第K个采样时刻采集到的任意一个驱动轮的第一运行速度和与 第K个采样时刻关联的、该驱动轮的预设运行速度指令值之差的绝对值是否大于该驱动轮 的、与第K个采样时刻关联的增速极限值。
[0071] 此处,与第K个采样时刻关联的增速极限值可以为自动导引运输车的驱动轮在K个 运行周期内的增速极限值。
[0072] 电子设备在子步骤2011获取到与第K个采样时刻关联的各驱动轮的增速极限值、 各驱动轮的预设运行速度指令值以及第K-I个采样时刻的各驱动轮的第一有效运行速度之 后,判断第K个采样时刻采集到的任意一个驱动轮的第一运行速度VK1和第K个运行周期对应 的该驱动轮的预设运行速度指令值vKR之差的绝对值是否大于该驱动轮的在第K个运行周期 内的增速极限值A νκ。
[0073] 子步骤2013,若是,第K个采样时刻该驱动轮的第一有效运行速度等于第K-I个采 样时刻该驱动轮的第一有效运行速度。
[0074] 步骤2012和步骤2013可以通过公式⑸、⑹来表达:
[0075] I vki—vkr I > Δ νκ (5);
[0076] VjKI = V' (K-I)I (6);
[0077]其中,V’κι是第K个米样时刻该驱动轮的第一有效运行速度,V’ (κ-ι)ι是第K-I个米样 时刻该驱动轮的第一有效运行速度。
[0078]子步骤2014,否则,第K个采样时刻该驱动轮的第一有效运行速度等于第K个采样 时刻采集到的该驱动轮第一运行速度via。
[0079] 步骤2014可以通过公式(7)、⑻来表达:
[0080] I vki-vkr I < Δ Vk (7);
[0081] V ’ κι = Vki ⑻。
[0082] 这样,在本实施例中,通过将在第K个采样时刻采集到的各驱动轮的第一运行速度 与第K个运行周期的各驱动轮的增速极限值进行比较。在K个采样时刻,当各驱动轮第一运 行速度与预设运行速度指令值之差小于第K个运行周期的增速极限值时,将各驱动轮的第 一运行速度作为该驱动轮在第K个采样时刻的第一有效运行速度;否则,将第K-I个采样时 刻的第一有效运行速度作为自动导引运输车在第K个采样时刻的第一有效运行速度。通过 上述方法来矫正任意一个采样时刻采集到的各驱动轮的第一运行速度来得到合理的第一 有效运行速度,可以避免使用繁复的场景配置参数来对各驱动轮的第一运行速度进行配 置。
[0083] 在本实施例的一些可选实现方式中,请参考图4,其示出了图2所示流程图中步骤 203的一个分解流程示意图400。在本实施例中自动导引运输车可以包括两个驱动轮,例如 左驱动轮和右驱动轮。左驱动轮和右驱动轮例如可以为左前驱动轮和右前度轮;还可以为 左后驱动轮和右后驱动轮。
[0084] 如图4所示,图2所示的步骤203可以包括如下子步骤:
[0085] 子步骤2031,判断左驱动轮的行进距离与自动导引运输车的行进距离之差是否大 于第一预设阈值α。
[0086] 电子设备可以判断左驱动轮自第K-I个采样时刻至第K个采样时刻期间,左驱动轮 的行进距离Skl与自动引导运输车的行进距离Sko的行进距离之差是否大于第一预设阈值α。 即判断如下不等式(9)是否成立:
[0087] Skl_Sko>ci (9);
[0088] 子步骤2032,若是,则将左驱动轮的预设运行速度指令值增加预设速度值。
[0089] 当上述不等式(9)成立时,电子设备将左驱动轮的预设运行速度指令值VLKR增加预 设速度值A V,也即:
[0090] Vlkr = Vlkr+ A v (10)。
[0091] 当自动导引运输车处于打滑路段导致左驱动轮打滑时,不等式(9)成立。驱动轮打 滑是由于驱动轮牵引力大于驱动轮与地面之间的摩擦力造成的。当自动导引运输车与地面 之间的摩擦力无法改变时,可以降低驱动轮的牵引力以改善驱动轮的打滑现象。电子设备 对左驱动轮的预设运行速度指令值VUiR增加预设速度值A V。当左驱动轮的预设运行速度指 令值增加时,自动导引运输车左驱动轮的牵引力减小,以便自动导引运输车驶出打滑路段。
[0092] 子步骤2033,否则,进一步判断左驱动轮的行进距离与自动导引运输车的行进距 离之差是否小于第二预设阈值。
[0093] 电子设备在判断不等式⑼不成立时,进一步判断左驱动轮自第K-I个采样时刻至 第K个采样时刻期间,左驱动轮的行进距离Skl与自动引导运输车的行进距离Sko的行进距离 之差是否小于第二预设阈值β。即判断如下不等式(11)是否成立:
[0094] Skl-Sko <β (11);
[0095] 其中,β例如可以与α互为相反数。
[0096] 子步骤2034,若是,则将左驱动轮的预设运行速度指令值减小预设速度值。
[0097] 当上述不等式(11)成立时,电子设备将左驱动轮的预设运行速度指令值VLKR减小 预设速度值Av,也即:
[0098] Vlkr = Vlkr- A v (12)。
[0099] 当自动导引运输车处于异常路段可能导致发生自动导引运输车堵转时,例如左驱 动轮无法转动,右驱动轮转动导致自动导引运输车以左驱动轮为中心转动,不等式(11)成 立。此时,电子设备对左驱动轮的预设运行速度指令值VUiR减小预设速度值Δ V。当左驱动轮 的预设运行速度指令值减小时,自动导引运输车降速,驱动轮转矩增加,使得左驱动轮转 动,从而使得自动导引运输车示出堵转路段。
[0100] 此处,第一预设阈值可以为通过大量实验得到的一个定值和第二预设阈值可以为 通过大量实验的到的一个定值。第一预设阈值和第二预设阈值可以互为相反数。
[0101] 子步骤2035,判断右驱动轮的行进距离与自动导引运输车的行进距离之差是否大 于第一预设阈值。
[0102] 电子设备可以判断右驱动轮自第K-I个采样时刻至第K个采样时刻期间,左驱动轮 的行进距离Skr与自动引导运输车的行进距离Sko的行进距离之差是否大于第一预设阈值。
[0103] 子步骤2036,若是,则将右驱动轮的预设运行速度指令值增加预设速度值。
[0104] 当自动导引运输车处于打滑路段导致右驱动轮打滑时。电子设备对右驱动轮的预 设运行速度指令值VRKR增加预设速度值Αν。当右驱动轮的预设运行速度指令值增加时,自 动导引运输车右驱动轮的牵引力减小改善右驱动轮打滑现象,以便自动导引运输车驶出打 滑路段。
[0105] 子步骤2037,否则,进一步判断驱动轮的行进距离与自动导引运输车的行进距离 之差是否小于第二预设阈值:
[0106] 子步骤2038,若是,则将左驱动轮的预设运行速度指令值减小预设速度值。
[0107] 当自动导引运输车处于异常路段导致自动导引运输车以右驱动轮为中心转动。此 时,电子设备对右驱动轮的预设运行速度指令值VRKR减小预设速度值A V。当右驱动轮的预 设运行速度指令值减小时,自动导引运输车降速,驱动轮转矩增加,使得右驱动轮转动,从 而使得自动导引运输车示出堵转路段。
[0108] 在本实施例中上述预设速度值可以为经过多次试验得到的定值。
[0109] 在本实施例的一些可选实现方式中,请参考图5,其示出了图2所示步骤204的一个 分解流程示意图500。如图5所示,图2所示的步骤204可以包括如下子步骤:
[0110] 子步骤2041,判断任意一个驱动轮的修正后的预设运行速度指令值与该驱动轮的 第一有效运行速度之差是否大于零。
[0111] 子步骤2042,若是,则增加该驱动轮的电机的转速。
[0112] 子步骤2043,否则,则减小该驱动轮的电机的转速。
[0113] 这样,如果对采集到的任意一个驱动轮的第一运行速度滤波后得到的第一有效运 行速度小于修正后的预设运行速度指令值,则增加该驱动轮的电机的转速,以使该驱动轮 的实际转速趋近修正后的预设运行速度指令值。如果对采集到的任意一个驱动轮的第一运 行速度滤波后得到的第一有效运行速度大于修正后的预设运行速度指令值,则减小该驱动 轮的电机的转速,以使该驱动轮的实际转速趋近修正后的预设运行速度指令值,从而保证 自动导引运输车不跑偏。
[0114] 在本实施例的一些可选实现方式中,上述自动导引运输车上预先安装有拍摄装 置。另外,在自动导引运输车运行的路径上预先设置有多个二维码图像,上述多个二维码图 像等间隔设置于地面上。每一个二维码用于记录二维码所在的位置。
[0115] 自动引导运输车可以由预先安装在自动导引运输车上的拍摄装置拍摄设置在规 划路径上的二维码图像。
[0116] 拍摄装置例如可以将拍摄到的二维码图像传输到电子设备中,由电子设备根据拍 摄到的二维码的图像和预存的运动轨迹规划算法来确定自动导引运输车的位姿信息。
[0117] 具体地,自动导引运输车经过二维码时,预先安装在自动导引运输车上的拍摄装 置拍摄到二维码图像。拍摄装置将拍摄到的二维码图像传送到电子设备。电子设备根据接 收到的二维码图像确定自动导体运输车的车体位姿信息,同时更新运动轨迹规划算法预存 的车体位姿信息初始值。在其他时刻,运动轨迹规划算法根据上述二维码确定的位姿信息 初始值,实时预估自动导引运输车在两个二维码之间行走时的位姿信息。
[0118] 上述运行轨迹算法可以为现有技术中的基于数值法的运行轨迹算法、基于搜索法 的运行轨迹算法和基于反解法的运行轨迹算法之中的一个,此处不赘述。
[0119] 请参考图6,其示出了根据本申请的自动导引运输车的控制方法的一个示意性原 理图。
[0120] 以自动导引运输车有左、右两个驱动轮为例进行说明,如图6所示的原理图600中, 在自动导引运输车运行在第K个运行周期。电子设备中预存的对应左驱动轮和右驱动轮的 预设运行速度指令值分别为VUiR和VRKR。在第K个运行周期的采样时刻分别采集安装在左驱 动轮和右驱动轮上的车轮转速测量传感器发出的脉冲信号计算出在第K个采样时刻分别对 应左驱动轮和右驱动轮的第一运行速度分别为VUQ和VRK1。此外,还可以通过读取从规划路 径的第一个路段的开始时间到第K-I个采样时刻期间左驱动轮上的车轮转速测量传感器发 出的脉冲信号的总数量N(K〇,根据公式(13)计算出从规划路径的第一个路段的开始时间到 第K-I个采样时刻期间左驱动轮的行驶距离
[0121]
Figure CN108983762AD00131
(13);
[0122] 其中,
[0123] Rl为左驱动轮的半径。
[0124] 同时,按照公式(14)计算出从开始时间到第K个采样时刻为止左驱动轮的行进距 ^Skli:
[0125] Skli = NkX 2JT X Rl (14);其中
[0126] Nk为从规划路径的第一个路段的开始时间到第K-I个采样时刻期间左驱动轮上的 车轮转速测量传感器发出的脉冲信号的总数量。
[0127] 接着由公式(15)计算出自第K-I个采样时刻至第K个采样时刻期间左驱动轮的行 驶距 I^iSkl : Skl = Skli-S (κ-1) Li (15) 〇
[0128] 同样,可以计算出自第K-I个采样时刻至第K个采样时刻期间右驱动轮的行驶距离 Skr0
[0129] 此外,还可以根据安装在自动导引运输车上的拍摄装置拍摄的预先设置在规划路 径上的地标二维码图像603和运动轨迹规划算法来分析第K-I个采样时刻自动导引运输车 的坐标以及第K个采样时刻自动导引运输车的坐标,从而计算出自动导引运输车从第K-I个 采样时刻到第K个采样时刻的行进距离SKQ。此处,二维码可以记录二维码所在位置的坐标。
[0130] 然后,将第K个采样时刻采集到的左驱动轮的第一运行速度Vua右驱动轮的第一运 行速度VRK1分别进行滤波601分别得到第K个采样时刻的左驱动轮和右驱动轮第一有效运行 速度V’ UU、ν’ Ria。接着根据采集到自第K-I个采样时刻至第K个采样时刻期间左驱动轮、右驱 动轮的行进距离Skl和SKR,与测量得到的自动导引运输车的行进距离SKQ,分别对与第K个运 行周期的左驱动轮和右驱动轮预设运行速度指令值VLKR、VRKR进行修正602,得到修正后的第 K个运行周期的左驱动轮的预设运行指令值V’ LKR、V’ RKR。
[0131] 对任意一个驱动轮,上述第K个采样时刻的第一有效运行速度以及与第K个采样时 刻关联的修正后的预设运行指令值同时作用在驱动轮的控制系统的输入端604来决定驱动 轮的驱动电机的转速。
[0132] 对任意一个驱动轮,驱动轮驱动控制系统605根据该驱动轮的修正后的预设运行 速度指令值与该驱动轮的第一有效运行速度之差的范围来调整驱动轮驱动电机606的转 速。当该驱动轮的修正后的预设运行速度指令值与该驱动轮的第一有效运行速度之差大于 零时,增加该驱动轮的电机的转速。当驱动轮的修正后的预设运行速度指令值与该驱动轮 的第一有效运行速度之差小于零时,减小该驱动轮的电机的转速。通过增加驱动轮的电机 606的转速使得驱动轮607的实际运行速度与修正后的预设速度指令值趋近。
[0133] 进一步参考图7,作为对上述各图所示方法的实现,本申请提供了一种自动导引运 输车的控制装置的一个实施例,该装置实施例与图2所示的方法实施例相对应,该装置具体 可以应用于各种电子设备中。
[0134] 如图7所示,本实施例上述的自动导引运输车的控制装置700包括:
[0135] 滤波单元701,配置用于对第K个采样时刻采集到的各驱动轮的第一运行速度滤 波,得到第K个采样时刻各驱动轮的第一有效运行速度;获取单元702,配置用于获取第K个 采样时刻与第K-I个采样时刻期间各驱动轮的行进距离和自动导引运输车的行进距离;修 正单元703,配置用于基于各驱动轮行进距离和自动导引运输车的行进距离修正各驱动轮 的预设运行速度指令值。第一确定单元704,配置用于基于第K个采样时刻各驱动轮的第一 有效运行速度与修正后的预设运行速度指令值确定各驱动轮电机的转速以使各驱动轮电 机的转速以使各驱动轮的转速接近修正后的预设速指令值。
[0136] 在本实施例中,上述滤波单元701可以根据上述方法采集第K个采样时刻的各驱动 轮的第一运行速度。然后各对驱动轮的第一运行速度进行滤波得到第K个采样时刻各驱动 轮的第一有效运行速度,例如可以使用限幅滤波法进行滤波。
[0137] 上述自动导引运输车的控制装置700还可以包括通信单元(图中未示出)。通信单 元可以通过有线连接方式或者无线连接方式从服务器(例如图1所示的服务器103)接收对 自动导引运输车(例如图1所示的自动导引运输车101)发出的运行指令,其中,上述运行指 令可以用于指示上述自动导引运输车的控制装置700控制上述自动导引运输车即将前往的 目的位置。
[0138] 上述自动导引运输车的控制装置700可以实时获取自动引导运输车的位姿信息, 并由位姿信息实时确定自动导引运输车的位置信息。上述位置信息可以包括自动导引运输 车在预设坐标系中的坐标信息。自动导引运输车的控制装置700根据自动引导运输车静止 时的位置作为初始位置。
[0139] 在一些应用场景中,上述通信装置可以将自动导引运输车的初始位置发送至服务 器,由服务器根据自动导引运输车的初始位置和目的位置规划自动导引运输车的规划路 径。并将该规划路径通过上述通信单元发送至自动导引运输车的控制装置700进行存储。
[0140] 在另外一些应用场景中,自动导引运输车的控制装置700可以根据自动导引运输 车的初始位置以及由服务器发送的目的位置,根据预先存储在其中的路径规划算法来规划 行驶路径。
[0141] 上述规划行驶路径可以包括N各个路段,每一个路段包括起始位置和终止位置。此 夕卜,每个路段对应自动导引运输车的一个运行周期。
[0142] 任意一个自动导引运输车的运行周期可以包括一个采样时刻。
[0143] 第K个运行周期对应第K个采样时刻。在第K个采样时刻,自动导引运输车的控制装 置700可以采集自动导引运输车各驱动轮的第一运行速度;以及自第K-I个采样时刻至第K 个采样时刻止各驱动轮的行进距离,以及自第K-I个采样时刻至第K个采样时刻止自动导引 运输车的行进距离。
[0144] 上述滤波单元701可以对第K个采样时刻由自动导引运输车的控制装置700采集到 的各渠道轮的第一运行速度进行滤波,得到第K个采样时刻个驱动轮的第一有效运行速度。
[0145] 上述滤波单元701进一步配置用于获取与第K个采样时刻关联的各驱动轮的增速 极限值、各驱动轮的预设运行速度指令值以及第K-I个采样时刻的各驱动轮的第一有效运 行速度;
[0146] 判断第K个采样时刻采集到的任意一个驱动轮的第一运行速度和与第K个采样时 刻关联的(即第K个运行周期的)、驱动轮的预设运行速度指令值之差的绝对值是否大于增 速极限值,
[0147] 若是,第K个采样时刻该驱动轮的第一有效运行速度等于第K-I个采样时刻该驱动 轮的第一有效运行速度;
[0148] 否则,第K个采样时刻该驱动轮的第一有效运行速度等于第K个采样时刻采集到的 该驱动轮第一运行速度;
[0149] 在一些应用场景中,上述自动导引运输车可以包括左驱动轮和右驱动轮。
[0150] 修正单元703进一步配置用于,判断左驱动轮的行进距离与自动导引运输车的行 进距离之差是否大于第一预设阈值。
[0151] 也即判断左驱动轮自第K-I个采样时刻至第K个采样时刻期间,左驱动轮的行进距 离Skl与自动引导运输车的行进距离Sko的行进距离之差是否大于第一预设阈值
[0152] 若是,则将左驱动轮的预设运行速度指令值增加预设速度值。
[0153] 否则,进一步判断左驱动轮的行进距离与自动导引运输车的行进距离之差是否小 于第二预设阈值。
[0154] 若是,则将左驱动轮的预设运行速度指令值减小预设速度值。
[0155] 此处,第一预设阈值可以为通过大量实验得到的一个定值和第二预设阈值可以为 通过大量实验的到的一个定值。第一预设阈值和第二预设阈值可以互为相反数。
[0156] 判断右驱动轮的行进距离与自动导引运输车的行进距离之差是否大于第一预设 阈值。
[0157] 也即判断右驱动轮自第K-I个采样时刻至第K个采样时刻期间,左驱动轮的行进距 离与自动引导运输车的行进距离的行进距离之差是否大于第一预设阈值。
[0158] 若是,则将右驱动轮的预设运行速度指令值增加预设速度值。
[0159] 否则,进一步判断驱动轮的行进距离与自动导引运输车的行进距离之差是否小于 第二预设阈值:
[0160] 若是,则将左驱动轮的预设运行速度指令值减小预设速度值。
[0161] 上述自动导引运输车的控制装置700还包括第二确定单元(图中未示出)。第二确 定单元配置用于,在任意一个采样时刻,根据预先安装在自动导引运输车上的拍摄装置所 拍摄到的二维码的图像和运动轨迹规划算法确定自动导引运输车的位姿信息。
[0162] 具体地,自动导引运输车经过二维码时,第二确定单元根据上述拍摄装置所拍摄 的二维码图像确定车体位姿信息;同时更新运动轨迹规划算法中关联的自动导引运输车车 体位置信息初始值。在其他时刻,第二确定单元可以根据上述更新后的自动导引运输车车 体位置信息初始值实时预估自动导引运输车在两个二维码之间行走时的位置信息。
[0163] 其中二维码用于记录二维码所在位置的坐标,等间隔设置于地面上。
[0164] 请参考图8,其示出了根据本申请的自动导引运输车的一个实施例的结构示意图。
[0165] 如图8所示,自动导引运输车包括CPU801、存储器802、车轮转速测量传感器803, CPU801、存储器802、测量角速度的传感器803通过总线804彼此相连。车轮转速测量803可以 安装分别安装在自动导引运输车的左右两侧车轮。根据本申请的自动导引运输车的控制方 法可以被实现为计算机程序,例如,该计算机程序中包含图2中步骤201-204中描述的操作 的指令。计算机程序可以存储在存储器802中。自动导引运输车的CPU 801通过调用存储器 802中存储的计算机程序,来实时对各驱动轮的第一运行速度进行滤波得到各驱动轮的第 一有效运行速度,对各驱动轮的预设运行指令值进行修正,并通过各驱动轮的第一有效运 行速度及修正后的预设运行指令值控制各驱动轮的驱动电机的转速来控制自动导引运输 车运行。
[0166] 本申请还提供了一种计算机可读介质,该计算机可读介质可以是自动导引运输车 中所包括的;也可以是单独存在,未装配入自动导引运输车中。该计算机可读介质承载有一 个或者多个程序,当一个或者多个程序被自动导引运输车执行时,使得自动导引运输车:对 第K个采样时刻采集到的各驱动轮的第一运行速度滤波,得到第K个采样时刻各驱动轮的第 一有效运行速度;获取第K个采样时刻与第K-I个采样时刻期间各驱动轮的行进距离和自动 导引运输车的行进距离;基于各驱动轮的行进距离和自动导引运输车的行进距离修正各驱 动轮的预设运行速度指令值;基于第K个采样时刻各驱动轮的第一有效运行速度与修正后 的预设运行速度指令值确定各驱动轮电机的转速。
[0167] 需要说明的是,上述计算机可读介质可以是计算机可读信号介质或者计算机可读 存储介质或者是上述两者的任意组合。计算机可读存储介质例如可以是一一但不限于一一 电、磁、光、电磁、红外线、或半导体的系统、装置或器件,或者任意以上的组合。计算机可读 存储介质的更具体的例子可以包括但不限于:具有一个或多个导线的电连接、便携式计算 机磁盘、硬盘、随机访问存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM 或闪存)、光纤、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述 的任意合适的组合。在本申请中,计算机可读存储介质可以是任何包括或存储程序的有形 介质,该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。而在本申请中, 计算机可读的信号介质可以包括在基带中或者作为载波一部分传播的数据信号,其中承载 了计算机可读的程序代码。这种传播的数据信号可以为多种形式,包括但不限于电磁信号、 光信号或上述的任意合适的组合。计算机可读的信号介质还可以是计算机可读存储介质以 外的任何计算机可读介质,该计算机可读介质可以发送、传播或者传输用于由指令执行系 统、装置或者器件使用或者与其结合使用的程序。计算机可读介质上包括的程序代码可以 用任何适当的介质传输,包括但不限于:无线、电线、光缆、RF等等,或者上述的任意合适的 组合。
[0168] 附图中的流程图和框图,图示了按照本申请各种实施例的系统、方法和计算机程 序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代 表一个模块、程序段、或代码的一部分,该模块、程序段、或代码的一部分包含一个或多个用 于实现规定的逻辑功能的可执行指令。也应当注意,在有些作为替换的实现中,方框中所标 注的功能也可以以不同于附图中所标注的顺序发生。例如,两个接连地表示的方框实际上 可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注 意的是,框图和/或流程图中的每个方框、以及框图和/或流程图中的方框的组合,可以用执 行规定的功能或操作的专用的基于硬件的系统来实现,或者可以用专用硬件与计算机指令 的组合来实现。
[0169] 以上描述仅为本申请的较佳实施例以及对所运用技术原理的说明。本领域技术人 员应当理解,本申请中所涉及的发明范围,并不限于上述技术特征的特定组合而成的技术 方案,同时也应涵盖在不脱离上述发明构思的情况下,由上述技术特征或其等同特征进行 任意组合而形成的其它技术方案。例如上述特征与本申请中公开的(但不限于)具有类似功 能的技术特征进行互相替换而形成的技术方案。

Claims (12)

1. 一种自动导引运输车的控制方法,其特征在于,所述方法包括: 对第K个采样时刻采集到的各驱动轮的第一运行速度滤波,得到所述第K个采样时刻各 所述驱动轮的第一有效运行速度; 获取所述第K个采样时刻与第K-I个采样时刻期间各驱动轮的行进距离和所述自动导 引运输车的行进距离; 基于所述各驱动轮的行进距离和所述自动导引运输车的行进距离修正各所述驱动轮 的预设运行速度指令值; 基于第K个采样时刻各所述驱动轮的第一有效运行速度与修正后的预设运行速度指令 值确定各驱动轮电机的转速; 其中,所述驱动轮行进距离由所述驱动轮自所述第K-I个采样时刻至第K个采样时刻期 间转动的次数确定,所述自动导引运输车的行进距离由所述自动导引运输车在第K个采样 时刻的位姿信息与第K-I个采样时刻的位姿信息确定;K多1,且K为正整数。
2. 根据权利要求1所述的方法,其特征在于,所述对第K个采样时刻采集到的各驱动轮 的第一运行速度滤波,包括: 获取与第K个采样时刻关联的各所述驱动轮的增速极限值、各所述驱动轮的预设运行 速度指令值以及第K-I个采样时刻的各所述驱动轮的第一有效运行速度; 判断第K个采样时刻采集到的任意一个驱动轮的第一运行速度和与第K个采样时刻关 联的、所述驱动轮的预设运行速度指令值之差的绝对值是否大于所述增速极限值, 若是,第K个采样时刻该驱动轮的第一有效运行速度等于所述第K-I个采样时刻该驱动 轮的第一有效运行速度; 否则,第K个采样时刻该驱动轮的第一有效运行速度等于所述第K个采样时刻采集到的 该驱动轮第一运行速度;其中 各所述驱动轮的增速极限值为与第K个采样时刻关联的加速度设定值与所述第K个采 样时刻关联的运行周期所用时间的乘积。
3. 根据权利要求1所述的方法,其特征在于,所述自动导引运输车包括左驱动轮和右驱 动轮, 所述基于所述各驱动轮的行进距离和所述自动导引运输车的行进距离修正各所述驱 动轮的预设运行速度指令值,包括: 判断所述左驱动轮的行进距离与所述自动导引运输车的行进距离之差是否大于第一 预设阈值: 若是,则将所述左驱动轮的预设运行速度指令值增加预设速度值; 否则,进一步判断所述左驱动轮的行进距离与自动导引运输车的行进距离之差是否小 于第二预设阈值; 若是,则将所述左驱动轮的预设运行速度指令值减小预设速度值; 判断所述右驱动轮的行进距离与所述自动导引运输车的行进距离之差是否大于第一 预设阈值: 若是,则将所述右驱动轮的预设运行速度指令值增加所述预设速度值; 否则,进一步判断所述右驱动轮的行进距离与自动导引运输车的行进距离之差是否小 于第二预设阈值; 若是,则将所述右驱动轮的预设运行速度指令值减小所述预设速度值; 其中,第一预设阈值与第二预设阈值互为相反数。
4. 根据权利要求1所述的方法,其特征在于,所述基于第K个采样时刻各所述驱动轮的 所述第一有效运行速度与修正后的所述预设运行速度指令值确定各驱动轮电机的转速,包 括: 判断任意一个驱动轮的修正后的预设运行速度指令值与该驱动轮的第一有效运行速 度之差是否大于零, 若是,则增加该驱动轮的电机的转速; 否则,则减小该驱动轮的电机的转速。
5. 根据权利要求1所述的方法,其特征在于,所述方法还包括: 在任意一个采样时刻,由预先安装在自动导引运输车上的拍摄装置拍摄到的二维码的 图像和运动轨迹规划算法确定自动导引运输车的所述位姿信息;其中 所述二维码用于记录二维码所在位置的坐标,等间隔设置;所述运动轨迹规划算法根 据所述二维码图像确定定位姿信息,预估自动导引运输车在两个二维码之间行走时的位姿 信息。
6. —种自动导引运输车的控制装置,其特征在于,所述装置包括: 滤波单元,配置用于对第K个采样时刻采集到的各驱动轮的第一运行速度滤波,得到所 述第K个采样时刻各所述驱动轮的第一有效运行速度; 获取单元,配置用于获取所述第K个采样时刻与第K-I个采样时刻期间各驱动轮的行进 距离和所述自动导引运输车的行进距离; 修正单元,配置用于基于所述各驱动轮的行进距离和所述自动导引运输车的行进距离 修正各所述驱动轮的预设运行速度指令值; 第一确定单元,配置用于基于第K个采样时刻各所述驱动轮的第一有效运行速度与修 正后的预设运行速度指令值确定各驱动轮电机的转速; 其中,所述驱动轮的行进距离由所述驱动轮自所述第K-I个采样时刻至第K个采样时刻 期间转动的次数确定,所述自动导引运输车的行进距离由所述自动导引运输车在第K个采 样时刻的位姿信息与第K-I个采样时刻的位姿信息确定;K多1,且K为正整数。
7. 根据权利要求6所述的装置,其特征在于,所述滤波单元进一步配置用于: 获取与第K个采样时刻关联的各所述驱动轮的增速极限值、各所述驱动轮的预设运行 速度指令值以及第K-I个采样时刻的各所述驱动轮的第一有效运行速度; 判断第K个采样时刻采集到的任意一个所述驱动轮的第一运行速度和与第K个采样时 刻关联的、所述驱动轮的预设运行速度指令值之差的绝对值是否大于所述增速极限值, 若是,第K个采样时刻该驱动轮的第一有效运行速度等于所述第K-I个采样时刻该驱动 轮的第一有效运行速度; 否则,第K个采样时刻该驱动轮的第一有效运行速度等于所述第K个采样时刻采集到的 该驱动轮第一运行速度;其中 各所述驱动轮的增速极限值为与第K个采样时刻关联的加速度设定值与所述第K个采 样时刻关联的运行周期所用时间的乘积。
8. 根据权利要求6所述的装置,其特征在于,所述自动导引运输车包括左驱动轮和右驱 动轮, 所述修正单元进一步配置用于: 判断所述左驱动轮的行进距离与所述自动导引运输车的行进距离之差是否大于第一 预设阈值: 若是,则将所述左驱动轮的预设运行速度指令值增加预设速度值; 否则,进一步判断所述左驱动轮的行进距离与自动导引运输车的行进距离之差是否小 于第二预设阈值; 若是,则将所述左驱动轮的预设运行速度指令值减小预设速度值; 判断所述右驱动轮的行进距离与所述自动导引运输车的行进距离之差是否大于第一 预设阈值: 若是,则将所述右驱动轮的预设运行速度指令值增加所述预设速度值; 否则,进一步判断所述右驱动轮的行进距离与自动导引运输车的行进距离之差是否小 于第二预设阈值; 若是,则将所述右驱动轮的预设运行速度指令值减小所述预设速度值; 其中,第一预设阈值与第二预设阈值互为相反数。
9. 根据权利要求6所述的装置,其特征在于,所述第一确定单元进一步配置用于: 判断任意一个驱动轮的修正后的预设运行速度指令值与该驱动轮的第一有效运行速 度之差是否大于零, 若是,则增加该驱动轮的电机的转速; 否则,则减小该驱动轮的电机的转速。
10. 根据权利要求6所述的装置,其特征在于,所述装置还包括第二确定单元, 所述第二确定单元配置用于, 在任意一个采样时刻,根据预先安装在自动导引运输车上的拍摄装置所拍摄到的二维 码的图像和运动轨迹规划算法确定自动导引运输车的所述位姿信息;其中 所述二维码用于记录二维码所在位置的坐标,等间隔设置;所述运动轨迹规划算法根 据所述二维码图像确定的位姿信息预估自动导引运输车在两个二维码之间行走时的位姿 信息。
11. 一种自动导引运输车,所述自动导引运输车包括: 一个或多个处理器; 存储装置,用于存储一个或多个程序; 当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实 现如权利要求1-5中任一所述的方法。
12. —种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器 执行时实现如权利要求1-5中任一所述的方法。
CN201710408256.XA 2017-06-02 2017-06-02 自动导引运输车的控制方法、装置及自动导引运输车 Pending CN108983762A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710408256.XA CN108983762A (zh) 2017-06-02 2017-06-02 自动导引运输车的控制方法、装置及自动导引运输车

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710408256.XA CN108983762A (zh) 2017-06-02 2017-06-02 自动导引运输车的控制方法、装置及自动导引运输车

Publications (1)

Publication Number Publication Date
CN108983762A true CN108983762A (zh) 2018-12-11

Family

ID=64501825

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710408256.XA Pending CN108983762A (zh) 2017-06-02 2017-06-02 自动导引运输车的控制方法、装置及自动导引运输车

Country Status (1)

Country Link
CN (1) CN108983762A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109784250A (zh) * 2019-01-04 2019-05-21 广州广电研究院有限公司 自动引导小车的定位方法和装置

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002202816A (ja) * 2000-12-28 2002-07-19 Daifuku Co Ltd 移動体
JP2004318721A (ja) * 2003-04-18 2004-11-11 Toshiba Tec Corp 自律走行車
CN101200193A (zh) * 2006-12-01 2008-06-18 村田机械株式会社 行走台车及其系统
CN103294059A (zh) * 2013-05-21 2013-09-11 无锡普智联科高新技术有限公司 基于混合导航带的移动机器人定位系统及其方法
CN105305921A (zh) * 2015-11-12 2016-02-03 上海新时达电气股份有限公司 电机编码器的位置反馈自适应校正方法及其伺服驱动器
CN105929198A (zh) * 2016-04-14 2016-09-07 南京航空航天大学 基于惯性原理的高稳定度实时预测转速测量方法
CN106325275A (zh) * 2016-09-14 2017-01-11 广州今甲智能科技有限公司 一种机器人导航的系统、方法及装置
CN106444750A (zh) * 2016-09-13 2017-02-22 哈尔滨工业大学深圳研究生院 一种基于二维码定位的智能仓储移动机器人系统

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002202816A (ja) * 2000-12-28 2002-07-19 Daifuku Co Ltd 移動体
JP2004318721A (ja) * 2003-04-18 2004-11-11 Toshiba Tec Corp 自律走行車
CN101200193A (zh) * 2006-12-01 2008-06-18 村田机械株式会社 行走台车及其系统
CN103294059A (zh) * 2013-05-21 2013-09-11 无锡普智联科高新技术有限公司 基于混合导航带的移动机器人定位系统及其方法
CN105305921A (zh) * 2015-11-12 2016-02-03 上海新时达电气股份有限公司 电机编码器的位置反馈自适应校正方法及其伺服驱动器
CN105929198A (zh) * 2016-04-14 2016-09-07 南京航空航天大学 基于惯性原理的高稳定度实时预测转速测量方法
CN106444750A (zh) * 2016-09-13 2017-02-22 哈尔滨工业大学深圳研究生院 一种基于二维码定位的智能仓储移动机器人系统
CN106325275A (zh) * 2016-09-14 2017-01-11 广州今甲智能科技有限公司 一种机器人导航的系统、方法及装置

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109784250A (zh) * 2019-01-04 2019-05-21 广州广电研究院有限公司 自动引导小车的定位方法和装置

Similar Documents

Publication Publication Date Title
US10683034B2 (en) Vehicle remote parking systems and methods
CN106297342B (zh) 一种提前、实时提示交通信号灯信息的提醒装置及方法
US9977431B2 (en) Automotive drone deployment system
CN105270410B (zh) 用于自主驾驶车辆的路径规划的精确曲率估计算法
US10829154B2 (en) Method and device for operating a vehicle
US10782694B2 (en) Prediction-based system and method for trajectory planning of autonomous vehicles
CN106908075B (zh) 大数据采集与处理系统及基于其电动汽车续航估计方法
US20170003685A1 (en) Attributed roadway trajectories for self-driving vehicles
CN108773373B (zh) 用于操作自动驾驶车辆的方法和装置
US10782693B2 (en) Prediction-based system and method for trajectory planning of autonomous vehicles
CN106325270B (zh) 基于感知和自主计算定位导航的智能车导航方法
CN102707724B (zh) 一种无人机的视觉定位与避障方法及系统
US9360865B2 (en) Transitioning from autonomous vehicle control to driver control
CN102269994B (zh) 无人搬送车以及行驶控制方法
CN108732584B (zh) 用于更新地图的方法和装置
US20200348403A1 (en) Vehicle Sensor Calibration System
US10145690B2 (en) Map information generation system, method, and program
US20160225255A1 (en) Spatial clustering of vehicle probe data
EP3385930B1 (en) Method and device for generating forecast vehicular information used for traveling on vehicle road network
CN104054117B (zh) 驾驶模型的制作装置、驾驶模型的制作方法、驾驶评价装置、驾驶评价方法以及驾驶辅助系统
EP3098798B1 (en) Data processing method, server and terminal for internet of vehicles
US10120381B2 (en) Identifying significant locations based on vehicle probe data
US20180011488A1 (en) Control policy learning and vehicle control method based on reinforcement learning without active exploration
CN107491072B (zh) 车辆避障方法和装置
US10467895B2 (en) Device and method for operating a parking facility

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: 20210311

Address after: Room a1905, 19 / F, building 2, No. 18, Kechuang 11th Street, Daxing District, Beijing, 100176

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

Address before: 101, 1st floor, building 2, yard 20, Suzhou street, Haidian District, Beijing 100080

Applicant before: Beijing Jingbangda Trading Co.,Ltd.

Effective date of registration: 20210311

Address after: 101, 1st floor, building 2, yard 20, Suzhou street, Haidian District, Beijing 100080

Applicant after: Beijing Jingbangda Trading Co.,Ltd.

Address before: 100080 Haidian District, Beijing, 65 Xing Shu Kou Road, 11C, west section of the western part of the building, 1-4 stories West 1-4 story.

Applicant before: BEIJING JINGDONG SHANGKE INFORMATION TECHNOLOGY Co.,Ltd.

Applicant before: BEIJING JINGDONG CENTURY TRADING Co.,Ltd.