首页> 中国专利> 用于确定特征可见性的系统、方法以及工业车辆

用于确定特征可见性的系统、方法以及工业车辆

摘要

根据此处描述的实施例,工业车辆可以包括与一个或多个处理器通信式耦合的基于环境定位(EBL)传感器。EBL传感器可以检测视场范围内的物体。一个或多个处理器可以执行机器可读指令以访问与工业设施关联的特征集合和遮挡集合。可以确定与遮挡集合中可检测遮挡和EBL传感器的传感器原点相交的遮挡路径。可以确定遮挡路径的特征相交点。至少部分基于特征相交点的定位,可检测特征可以被归类为被遮挡可检测特征。利用已排除被遮挡可检测特征的特征集合,工业车辆可以被导航穿过工业设施。

著录项

  • 公开/公告号CN105874396A

    专利类型发明专利

  • 公开/公告日2016-08-17

    原文格式PDF

  • 申请/专利权人 克朗设备公司;

    申请/专利号CN201480071852.8

  • 申请日2014-10-29

  • 分类号G05D1/02;G05B19/19;G06T7/00;

  • 代理机构北京志霖恒远知识产权代理事务所(普通合伙);

  • 代理人陈姗姗

  • 地址 美国俄亥俄州

  • 入库时间 2023-06-19 00:17:55

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2019-01-01

    授权

    授权

  • 2016-09-14

    实质审查的生效 IPC(主分类):G05D1/02 申请日:20141029

    实质审查的生效

  • 2016-08-17

    公开

    公开

说明书

相关申请的交叉引用

本申请要求2013年10月31日递交的美国临时申请No.61/897,867以及2014年10月28号递交的美国申请No.14/525,724的优先权。

背景技术

本说明书大体上涉及用于确定特征可见性的系统、方法以及工业车辆,更具体的,涉及用于利用可见特征以及排除被遮挡特征来给工业车辆导航的系统、方法以及工业车辆。

工业车辆,例如包括叉式起重车辆、手动和电动托盘车和/或其他材料搬运车辆,可以用来在工业环境中移动物件。工业车辆可以被配置成导航通过该环境的自动引导车辆或手动引导车辆。为了便利自动引导、导航或者二者,工业车辆可以被改变以适合在该环境内的定位,例如工业车辆的姿势以及位置。相应的,工业车辆可以改成具有多个传感器用以检测环境中的特征以及多个处理器用以使用检测的特征来确定工业车辆的定位。然而,特征可能会被其他物体遮挡致使特征不会被传感器检测到。不能检测到被遮挡特征可能会导致定位的失败,由此产生不精确的结果并且需要增长的处理时间。

因此,需要用于确定特征可见性的替代系统、方法以及工业车辆。

发明内容

本公开涉及用于确定特征可见性的系统、方法以及设备,其尤其适用于工业车辆特别是升降运送车的导航和定位。在一个实例中,确定特征可见性的方法可以包括提供与物理环境关联的特征集合。可以提供遮挡集合。遮挡集合可以与物理环境关联。传感器的位置可以相对于物理环境而确定。传感器存在一个检测范围。可检测特征集合可以从特征集合中选择。可检测特征集合可以包括与在传感器定位的检测范围内的特征位置关联的可检测特征。可检测遮挡集合组可以从遮挡集合中选择。可检测遮挡集合可以包括与在传感器定位的检测范围内的遮挡位置关联的可检测遮挡。可以确定遮挡路径。遮挡路径可能与可检测遮挡和传感器的传感器源相交。遮挡路径的特征相交可以由一个或多个处理器自动确定。特征相交点可以被定位于可检测特征或可检测特征的投影。可检测特征可以由一个或多个处理器至少部分基于特征相交点而自动确定为可见。

在一个实例中,工业车辆可以包括与一个或多个处理器通信式耦合的基于环境定位(EBL)传感器。EBL传感器可以检测视场范围内的物体。一个或多个处理器可以执行机器可读指令以访问与工业设施关联的特征集合和遮挡集合。EBL传感器的传感器原点的定位可以相对于工业设施来提供。可以确定与遮挡集合中可检测遮挡和EBL传感器的传感器原点相交的遮挡路径。可以确定遮挡路径的特征相交点。特征相交点可以被定位于特征集合中的可检测特征或特征集合中可检测特征的投影。至少部分基于特征相交点的定位,可检测特征可以被归类为被遮挡可检测特征。利用已排除被遮挡可检测特征的特征集合,工业车辆可以被导航穿过工业设施。

在另一个实例中,用于确定特征可见性的系统包括一个或多个处理器以及工业车辆,该工业车辆包括与该一个或多个处理器通信式耦合的基于环境定位(EBL)传感器。EBL传感器可以检测视场范围内的物体。一个或多个处理器可以执行机器可读指令以访问与工业设施关联的特征集合和遮挡集合。EBL传感器的传感器原点的定位可以相对于工业设施来提供。可以确定与遮挡集合中可检测遮挡和EBL传感器的传感器原点相交的遮挡路径。可以确定遮挡路径的特征相交点。特征相交点可以被定位于特征集合中可检测特征或特征集合中可检测特征的投影。至少部分基于特征相交点的定位,可检测特征可以被归类为被遮挡可检测特征。利用已排除被遮挡可检测特征的特征集合,工业车辆可以被导航穿过工业设施。

在进一步的实例中,用于确定特征可见性的方法可以由执行机器可读指令以实现功能的一个或多个处理器来实施。所述方法可以包括访问与工业设施关联的特征集合和遮挡集合。EBL传感器的传感器原点的定位可以相对于工业设施来提供。可以确定与遮挡集合中可检测遮挡和EBL传感器的传感器原点相交的遮挡路径。可以确定遮挡路径的特征相交点。特征相交点被定位于特征集合中可检测特征或特征集合中可检测特征的投影。至少部分基于特征相交点的定位,可检测特征可以被归类为被遮挡可检测特征。利用已排除被遮挡可检测特征的特征集合,工业车辆可以被导航穿过工业设施。

根据所述工业车辆、方法或系统中的任一项,特征集合中可检测特征可以对应于位于EBL传感器视场内的工业设施的特征。

根据所述工业车辆、方法或系统中的任一项,遮挡集合中可检测遮挡对应于位于EBL传感器视场内的工业设施的遮挡。备选的或附加的,工业设施的遮挡可以将EBL传感器的视场截断为一个截断视场。被遮挡可检测特征可以对应于位于EBL传感器的视场内且在EBL传感器的截断视场外的工业设施的特征。

根据所述工业车辆、方法或系统中的任一项,遮挡路径可以与遮挡集合中可检测遮挡相交于起点或终点。一个或多个处理器可以执行机器可读指令以确定沿着遮挡路径的特征相交点、可检测遮挡的起点或终点以及EBL传感器的传感器原点的顺序。至少部分基于该顺序,可检测特征可以被归类为被遮挡可检测特征。备选的或附加的,一个或多个处理器执行机器可读指令以确定与特征集合中的可检测特征和EBL传感器的传感器原点相交的特征路径。特征路径和遮挡集合的可检测遮挡的相交点可以被确定。至少部分基于该相交点,可检测特征可以被归类为被遮挡可检测特征。备选的或附加的,所述顺序可以优先于相交点的确定而确定。

根据所述工业车辆、方法或系统中的任一项,一个或多个处理器执行机器可读指令以确定与特征集合中可检测特征的起点和EBL传感器的传感器原点相交的第一特征路径。可以确定与特征集合中可检测特征的终点和EBL传感器的传感器原点相交的第二特征路径。当可检测遮挡的一点被特征集合中可检测特征、第一特征路径和第二特征路径划分界线的区域所约束时,可检测遮挡的这一点可以被确定为位于内部。至少部分基于所述可检测遮挡的这一点被确定位于内部,可检测特征可以被归类为被遮挡可检测特征。备选的或附加的,一个或多个处理器可以执行机器可读指令以确定第一特征路径和遮挡集合的可检测遮挡之间的相交点。至少部分基于该相交点,可检测特征可以被归类为被遮挡可检测特征。备选的或附加的,所述可检测遮挡的这一点可以优先于所述相交点的确定而确定。备选的或附加的,所述相交点可以优先于可检测遮挡的这一点被确定为位于内部而确定。备选的或附加的,所述可检测遮挡的这一点可以是可检测遮挡的起点,或者可检测遮挡的终点。备选的或附加的,遮挡路径可以与遮挡集合中可检测遮挡相交于起点或终点。一个或多个处理器执行机器可读指令以确定沿着遮挡路径的特征相交点、可检测遮挡的起点或终点、EBL传感器的传感器原点的顺序。至少部分基于该顺序,可检测特征可以被归类为被遮挡可检测特征。备选的或附加的,所述顺序可以优先于所述可检测遮挡的点被确定为位于内部而确定。

根据所述工业车辆、方法或系统中的任一项,根据利用启发式成本组织的遮挡计算,所述可检测特征可以被归类为被遮挡可检测特征。

根据所述工业车辆、方法或系统中的任一项,工业车辆可以被配置为自动引导车辆。

根据所述工业车辆、方法或系统中的任一项,工业设施可以被映射为二维模型。

根据所述工业车辆、方法或系统中的任一项,EBL传感器可以包括多个传感器。

本文描述的实例中提供的这些以及附加特征可以结合具体实施方式描述和附图得到更全面的理解。

附图说明

附图中阐述的实施例只是示意性和示例性的,不旨在于限制权利要求所定义的主题。当结合如下附图阅读时,可理解对示意性实施例的下列详细描述,附图中类似的结构使用类似的参考标号指示,其中:

图1示意性地描绘了根据本文示出和描述的一个或多个实施例的工业车辆;

图2示意性地描绘了根据本文示出和描述的一个或多个实施例的具有覆盖有地图数据的可见和不可见特征的物理环境;

图3示意性地描绘了根据本文示出和描述的一个或多个实施例的传感器;

图4示意性地描绘了根据本文示出和描述的一个或多个实施例的用于确定特征可见性的示例性处理;

图5示意性地描绘了根据本文示出和描述的一个或多个实施例的用于执行遮挡计算以归类特征可见性的方法;

图6A-6D示意性地描绘了根据本文示出和描述的一个或多个实施例的用以分类特征相交点的示例性方案;

图7A-13B示意性地描绘了根据本文示出和描述的一个或多个实施例的用于执行遮挡计算以归类特征可见性的方法;

图14A-14C示意性地描绘了根据本文示出和描述的一个或多个实施例的用于针对多个遮挡确定特征可见性的示例性处理;

图15示意性地描绘了根据本文示出和描述的一个或多个实施例的用于执行遮挡计算以归类特征可见性的方法;以及

图16示意性地描绘了根据本文示出和描述的一个或多个实施例的用于执行遮挡计算以归类特征可见性的方法。

具体实施方式

本文所描述的实施例大体上涉及用于导航通过诸如仓储设施的物理环境的基于环境定位(EBL)技术。在某些实施例中,EBL传感器可以安装在例如工业车辆、机器人等上面。相应的,EBL传感器能够检测物理环境中的物体并且从这些物体提取特征。EBL传感器可以通信式耦合到特征列表并且将提取的特征与来自特征列表的特征进行匹配以确定工业车辆(例如,起重车辆,或者叫起重叉车或叉车)相对于物理环境的位置。例如,特征列表可以以一种类似于地图的方式与物理环境相关联。

参阅图1,图1示意性地描述了工业车辆10的实施例。工业车辆10可以是被配置以确定定位信息(也即,关于工业车辆10相对于环境的位置的信息)的任何车辆。工业车辆10可以是配置用来举起或者移动负荷的车辆,例如叉式起重车辆,前移式叉车,转叉式堆高机,堆高车,牵引车,托盘车,高/低,堆垛机,拖车装载机,侧装载机,叉葫芦等。相应的,工业车辆10可以包括沿基本上竖直方向延伸的桅杆12和可操作以沿桅杆12行进以在基本上竖直方向上举起和放下的叉头14。在某些实施例中,叉头14可以配置成横向行进以调整叉头14相对于桅杆12或相互之间的横向相对位置。备选的或附加的,工业车辆10可以包括一些能对负荷(例如,圆桶,小桶或者纸卷等)提供钳力的部件。工业车辆10可以进一步包括一个或多个轮子16,用于沿着某个表面横穿以沿期望路径行进。相应的,通过一个或多个轮子16的旋转,工业车辆10能向前向后导向。附加的,通过操控一个或多个轮子16,可以使得工业车辆10变换方向。动力系统18可以配置用以施加力来驱动叉头14或者操控轮子16或二者两者。动力系统18可以包括机械系统、液压系统、电力系统、气动系统或其组合。

工业车辆10可以进一步包括用以执行机器可读指令的一个或多个处理器20以及与该一个或多个处理器20通信式耦合的存储器22。值得注意的是:为了定义和描述本公开的目的,“处理器”一词通常意义上是指根据机器可读指令来执行某些功能的设备,或者说被配置用于通过一种类似于机器可读指令的方式来执行某些功能的设备,。上述类似于机器可读指令的方式包括例如集成电路,微型芯片,计算机,中央处理单元,图形处理单元,现场可编程门阵列(FPGA),专用集成电路(ASIC)或者任何其他计算设备。附加的,请注意此处提及的“存储器”一词通常意义上是指能够存储数据或机器可读指令以供后续取回的一个或多个设备,包括但不限于RAM,ROM,闪存,硬盘驱动器或其组合。

所述一个或多个处理器20、存储器22或二者可以集成设置于EBL传感器30、工业车辆10或二者内。然而,在不脱离本公开范围的情况下,一个或多个处理器20、存储器22以及EBL传感器30可以是相互通信式耦合的分立部件。这里描述的“通信式耦合”一词是指部件之间彼此能够进行交换信号,例如经由导电媒介的电信号,通过空气的电磁信号,通过光波导的光信号或者其他类似信号。

进一步请注意:这里描述的机器可读指令可以包括用任意版本(例如1GL,2GL,3GL,4GL,or 5GL)的任何编程语言编写的逻辑或者算法,编程语言例如可以为处理器能直接执行的机器语言,或者汇编语言,面向对象编程(OOP)、脚本语言、微代码等,其可以被汇编或者编译成机器可读指令并且存储于机器可读介质上。或者,逻辑或者算法可以用硬件描述语言(HDL)来编写,例如可以通过FPGA配置或ASIC或其等同方式实现。

工业车辆10可以进一步包括用来发射和接收数据信号的通信电路24。通信电路24能够通信式耦合到一个或多个处理器20、存储器22、或者二者。通信电路24可以包括必要的硬件以编码数据和解码数据,以供经由局域网、个人区域网络、蜂窝式网络等通信。相应的,工业车辆10可以利用通信电路24以经由万维网或互联网传送数据。

工业车辆10可以进一步包括用来检测特征的EBL传感器30。EBL传感器30可以包括一个或多个传感器,每个可操作以采集围绕工业车辆10的环境条件等。相应的,EBL传感器30可以包括能够检测指示围绕工业车辆10的环境条件的量的任何传感器,例如激光扫描仪,激光测距仪,编码器,压力传感器,照相机,射频识别(RFID)检测器,光学检测器,照相机,超声波测距仪,或其他类似。值得注意的是,在此提及的“传感器”一词表示测量物理量并将其转换成与物理量的测量值相关的信号的一个或多个设备。可以预期的是:上述“信号”可以是电,光,磁,电磁,或能够通过介质传播的任何其它形式。预期信号包括但不限于,DC,AC,正弦波,三角波,方波等。

EBL传感器30可以安装或者物理依附于在工业车辆10内部或者上面的任意位置。通常情况下,EBL传感器30的定位取决于被检测的量,也即,EBL传感器30可以被有利的安置从而被检测的量有可能位于检测范围中,也就是工业车辆10的操作期间EBL传感器30的视场34中(如图3所示)。在某些实施例中,EBL传感器30可以通信式耦合到所述一个或多个处理器20、存储器22、或者二者。相应的,所述一个或多个处理器20能够接收来自EBL传感器30的传感器数据。传感器数据可以在传输给一个或多个处理器20之前由EBL传感器30处理。备选的附加的,传感器数据可以由一个或多个处理器20在接收到传感器数据之后进行处理。

工业车辆10的部件可以通信式耦合到一个或多个处理器20(通常用箭头指示)。工业车辆10的这些部件可以经由任何有线或者无线总线进行通信式耦合,其中无线总线可以包括控制器区域网络(CAN)总线,ZigBee,蓝牙,本地互联网络(LIN),时间触发的数据总线协议(TTP)或其他合适的通信策略。相应的,工业车辆10的一个或多个处理器20可以执行机器可读指令以自动实现其功能。因此,在某些实施例中,工业车辆10可以被配置为自动引导车辆(AGV)。

同时参考图1和图2,工业车辆10可以通过执行机器可读指令的一个或多个处理器20来自动导航。在某些实施例中,当工业车辆10被导航时,车辆的定位可以被EBL传感器30监测。例如,工业车辆10可以沿着工业设施100的表面102自动导航,工业设施100包括例如仓库,制造工厂,或任何适合容纳货物或者负荷的围场。值得注意的是,这里提及的“表面”一词可以被应用于表示任何适合工业车辆10运行的广阔区域。

为了辅助导航,工业车辆10可以确定工业车辆10相对于工业设施100的定位位置。工业车辆10的定位位置的确定可以通过比较由EBL传感器30检测的特征100与具有相应特征集合122的地图数据120来实现。地图数据120可以本地存储在存储器22中,其可以利用经由通信电路24接收到的数据进行定期更新,或者,地图数据120可以经由通信电路24而访问,也就是说地图数据120可以由服务器之类的提供。例如,特征集合122可以使用数据结构存储在存储器22中,数据结构例如可以为分层数据结构,树形结构(例如,特征集合122可以被插入到一个四叉树)等。相应的,数据结构可以用作对应于工业设施100的特征110的特征集合122的数据实例。给出定位位置和期望位置,可以确定工业车辆10的行进路径。一旦行进路径已知,工业车辆10可以沿着行进路径行进以在工业设施100的表面102导航。具体的,一个或多个处理器20可以执行机器可读指令来操作工业车辆10。例如,一个或多个处理器20可以调整车轮16的转向并且控制油门使工业车辆10在表面102上导航。

如上面所述,EBL传感器30可以被配置用于检测其环境(诸如工业设施100)中的特征110。取决于用于形成EBL传感器30的传感器类型,EBL传感器30能够从某个特定位置检测的特征110可能受限。例如,某些特征110可能只能被一些特定的传感器类型检测到。其他受限因素可以包括EBL传感器30的视场34,或者环境中的遮挡112.

同时参阅图2和3,EBL传感器30可以被配置用于检测其视场34中的物体。视场34可以表示为一个从EBL传感器30的传感器原点32延伸出来的空间区域,传感器原点也即EBL传感器的可以用来作为空间参考点或基准的任何位置。在某些实施例中,EBL传感器30的传感器原点32可以是EBL传感器30配置用来接收从环境感测的信号的那部分。视场34的范围可以被进一步定义为EBL传感器30的距离跨度D和EBL传感器30的角度跨度。特别的,视场34可以表示为通过将距离跨度D从EBL传感器30的传感器原点32扫过角度跨度而形成的大体的弧形区域。应当理解,尽管为了清楚起见,在图3中将视场34描绘为大体上是一个弧形区域,但是视场34也可以是对应于EBL传感器30的检测能力的任何形状。另外,值得注意的是,EBL传感器30可以包括一个或多个传感器,每个具有传感器原点32和视场34。相应的,在这些实施例中,EBL传感器30可以包括多个传感器原点和对应的视场。

正如上面所指出来的,EBL传感器30的特征检测能力可能会受到工业设施100内的遮挡112的限制。遮挡112可以是物理环境中阻碍或阻止EBL传感器30检测物体的物体。在工业设施100的上下文中,遮挡112可以是不能传输从EBL传感器30发射或者导向EBL传感器30的信号的任何物体,例如,墙体,托盘,货架,工人或者其他类似的东西。相应的,如图2所述,在工业设施100里的遮挡112可以截断或者限制EBL传感器30的视场34(图3)的范围,使之成为一个被截断的视场40(如图2所示)。

再次参考图1和图2,地图数据120可以包括对应于工业设施100的特征110的特征集合122以及对应于工业设施100的遮挡112的遮挡集合124。通常而言,地图数据120可以包括坐标系统,其将特征集合122的实例映射到物理空间中的对应特征110,以及将遮挡集合124的实例映射到物理空间中的对应遮挡112。在某些实施例中,特征110和遮挡112可以在地图数据120中表示为几何对象,诸如体积,表面,边缘,曲线,点,以及适合表示物理物体的其他对象。

相应的,地图数据120的遮挡集合124和特征集合122的示例可以使用对应于坐标系统(例如笛卡尔坐标系统)的几何图形来实施,例如二维点(x,y),三维点(x,y,z),由二维点(x1,y1)和(x2,y2)定义的二维线段,由三维点(x1,y1,z1)和(x2,y2,z2)定义的三维线段。在某些实施例中,例如具有对称性的环境(例如仓库货架),工业设施100可以被映射到一个二维模型。相应的,通过忽略地图数据120中的工业设施100的特征110和遮挡112的z维(高度),计算需求可以降低。

特征110、遮挡112以及EBL传感器30可以被建模成投影在基本上平行于表面102的平面上。例如,每一个特征110可以在地图数据120上几何地实施为点特征114或者线特征116。特别的,每个点特征114在特征集合122里面可以用二维坐标系统中的点(x,y)来定义。每一个线特征116在特征集合122中可以用二维坐标系统中的起点(x1,y1)和终点(x2,y2)来定义。类似的,遮挡集合124中的每一个遮挡125可以用二维坐标系中对应于遮挡112之一的起点(x1,y1)和终点(X2,Y2)来定义。值得注意的是,尽管为了清楚起见在这里描述的实施例是针对二维映射而描述的,但是本文提供的示例也可以扩展至三维,例如,通过把工业设施100的特征110和遮挡112的z维信息建模到地图数据120中。

图4示意性地描述了将被遮挡特征排除在用于执行定位或导航之外的示例性方法200。同时参考图1和图4,方法200描述了一个迭代方法,用以搜索特征集合122中未访问的(也即,未分析的)实例,以及比较特征集合122的未访问实例和遮挡集合124的未访问实例。值得注意的是,尽管枚举和描述的方法200中的处理是按特定顺序实施的,在不脱离本发明思想的情况下,处理也可以用另外的顺序来实施。例如,在某些实施例中,遮挡计算的顺序可以根据工业设施的探索而排序,下文将进行更为详细的描述。另外值得注意的是,某个或者多个处理在不脱离本文实施例范围的情况下可以省略。

同时参考图1至图4,在处理202中,可以使用具有与工业设施100的特征110关联的特征集合122的地图数据120来执行初始空间查询。可检测特征集合126可以从特征集合122中选择。可检测特征集合126可以对应于EBL传感器30的检测范围内的特征110相对应,该检测范围通常对应于未被截断的视场34(如图3所绘)。在某些实施例中,EBL传感器30的定位可以相对于工业设施100来确定,例如通过定位。EBL传感器30的定位可以被用来确定EBL传感器30的检测范围,正如上面针对视场34所描述。EBL传感器30的检测范围可以与地图数据120里面的特征集合122的每一个实例进行比较。可检测特征集合126可以包括特征集合122中与EBL传感器30的视场34里的位置相关联的部分。相应的,可检测特征集合126可以取决于EBL传感器30的定位。此外,可检测特征集合126可以随着工业车辆10被导航(也即移动)通过工业设施100而动态更新。

可选择的或者附加的,可检测遮挡集合128可以从地图数据120的遮挡集合124中选择。EBL传感器30的视场34可以与地图数据120中遮挡集合124的每一个实例的位置进行比较。可检测遮挡集合128可以包括遮挡集合124中与位于EBL传感器30的视场34内的位置相关联的部分。相应的,可检测遮挡集合128可以以类似于可检测特征集合126的方式动态更新。

对应于EBL传感器30的视场34内的每一个遮挡112的地图数据120可以与对应于EBL传感器30的视场34内的每一个特征110的地图数据120进行比较,以确定哪一个/哪些特征110应当与地图数据120比较以确定EBL传感器30和/或工业车辆10的定位。相应的,如果对应于可检测特征集合126的任何特征110由于对应于可检测遮挡集合128的遮挡112而不可见,这些不可见的特征110可以被确定为被遮挡130。在定位的过程中,可检测特征集合126中对应于被确定为被遮挡130的特征110的实例可以省略。备选的或附加的,对应于可检测特征集合126中未被可检测遮挡集合128的实例阻挡的实例的特征110可以被确定为可见132。相应的,在定位的过程中,可检测特征集合126中对应于被确定为可见132的特征110的实例可以被用来定位和导航。

另外的,在某些实施例中,EBL传感器30可以包括一个或多个传感器,每个具有传感器原点32和视场34。相应的,特征110的可见性可以取决于EBL传感器30中的该一个或多个传感器的每一个。在这些实施例中,可以执行对应于EBL传感器30的该一个或多个传感器的每一个的视场34内的遮挡112的地图数据120与对应于EBL传感器30的该一个或多个传感器的每一个的视场34内的每一个特征110的地图数据120的比较。因此,值得注意的是,尽管这里所描述的实施例都是针对单个传感器原点32描述的,但是这里提供的实施例可以针对EBL传感器30的每一个传感器执行遮挡计算。在某些实施例中,如果特征110被EBL传感器30的任何传感器确定为可见,那么特征110可以被EBL传感器用作导航或定位。备选的或附加的,如果特征110被EBL传感器30的所有传感器确定为被遮挡130,那么特征110可以被EBL传感器排除用作导航或定位。

方法200可以包括计算管理功能204,用以确保可检测特征集合126与可检测遮挡集合128进行比较以及生成可见特征列表134。值得注意的是,可见特征列表134可以包括适用于与导航或定位一起使用、跟踪可检测特征的任何数据管理技术,,例如,列表,阵列,性质,属性或者其他。在一些实施例中,计算管理功能204可以配置用于确保可检测特征集合126的每一个实例与可检测遮挡集合128的每一个实例进行比较。例如,如图4描述的实施例,计算管理功能204可以用嵌套循环的方式迭代式的比较可检测特征集合126的每一个实例和可检测遮挡集合128的每一个实例。特别的,计算管理功能204可以包含特征循环处理206和相对于特征循环处理206嵌套的遮挡循环处理208。

特征循环处理206可以配置用以在整个可检测特征集合126的实例上迭代以确保每一个实例(也就是说可检测特征)都被访问并且被用于和可检测遮挡集合128的每一个实例(也即,可检测遮挡)进行比较。例如,在图4描述的实施例中,特征循环处理206可以确定可检测特征集合126是否包括任何还没有被评估的实例。如果可检测特征集合126的所有实例都已被评估,那么方法200可以将可见特征列表134返回给EBL传感器以用于定位和导航。如果不是可检测特征集合126的所有实例都已被评估,则方法200可以前进到遮挡循环处理208以评估没有被访问的实例。

遮挡循环处理208可以配置用以在整个可检测遮挡集合128的实例上迭代使得每一个可检测遮挡与可检测特征集合126的每一个可检测特征进行比较。例如,在图4描述的实施例中,遮挡循环处理208可以确定可检测遮挡集合128是否包括任何尚未被评估的实例。如果不是可检测特征集合126的所有实例都已被评估,则方法200可以前进到遮挡计算处理210以使用未被访问的可检测特征和未访问的遮挡来执行遮挡计算。如果可检测遮挡集合128的所有实例都已被评估,则方法200可以将可检测特征集合126的未访问实例归类为已访问实例并且前进到视场验证处理212,视场验证处理212验证特征110中被归类为可见132的部分是否与视场34一致(如图3)。

仍然参考图1-图4,如果特征110中被归类为可见132的部分与视场34一致,则方法200可以前进至处理213。在处理213中,可检测特征集合126中对应于该特征110的实例可以被包括在可见特征列表134中,并且方法200可以前进至计算管理功能204。如果特征110中被归类为可见132的部分与视场34不一致,则特征110可以认为被遮挡130。相应的,方法200可以前进至处理216。在处理216中,可检测特征集合126中对应于被分类为被遮挡130的特征物110的实例,可以从可见特征列表134中被排除,并且方法200可以前进到计算管理功能204。

值得注意的是,尽管针对整个可检测特征集合126上的“循环”描绘了一个特定的计算管理功能204,但是其他的替代方法也可以使用,只要可检测特征集合126的每一实例都如所描述的被分析。例如,特征循环处理206可以嵌套于遮挡循环处理208中。备选的或附加的,迭代循环可以用平行处理代替,也就是说,代替于按顺序执行的迭代式比较,某些或者全部的比对可以同时进行。特别的,正如下面提到的,多个遮挡在单个特征上的影响可以通过叠加来确定。相应的,这样的计算可以基本上并行进行,并且可以服从并行计算。

同时参考图4和图5,遮挡计算处理210可以配置用以比较未访问的可检测特征和未访问遮挡。在某些实施例中,遮挡计算处理210可以配置用以将点特征114归类为被遮挡130或者可见132。例如,一个点特征114可以利用线段或者线段相交测试来与遮挡125进行比较。特别的,线段136可以创建在EBL传感器30的传感器原点32和与线段136相关联的点特征114之间。也就是说,线段136可以被传感器原点32和点特征114划分界线。在线段136与遮挡125相交的比较中,与线段136相关联的点特征114可以被归类为被遮挡130。在线段136与遮挡125不相交的比较中,与线段136相关联的点特征114可以被归类为可见132。正如下述更详细的描述,当点特征114被归类为被遮挡130时,点特征114可以从定位和导航中省去。备选的或附加的,当点特征114被归类为可见132时,点特征114可以被用来定位和导航。

同时参考图4和图6A-图6D,在某些实施例中,遮挡计算处理210可以配置用以执行遮挡计算。遮挡计算特征化线特征116和遮挡125之间的关系。例如,遮挡路径140,遮挡路径142或者两者都可以用来特征化线特征116。遮挡路径140和遮挡路径142的每一个可以延伸通过遮挡125以及EBL传感器30的传感器原点32。在某些实施例中,遮挡路径140可以与遮挡125相交于起点144,并且遮挡路径142可以与遮挡125相交于终点146。

在某些实施例中,第一特征相交点152可以利用遮挡路径140来确定并且第二特征相交点154可以利用遮挡路径142来确定。例如,线特征116可以是被起点156和终点158划分界线的线段。第一特征相交点152可以针对线特征116的起点156确定,并且第二特征相交点154可以针对线特征116的终点158来确定。相应的,第一特征相交点152可以与线特征116的起点156相关联。第二特征相交点154可以与线特征116的终点158相关联。第一特征相交点152可以定义为遮挡路径140与线特征116或线特征116的投影160之间的相交点。类似的,第二特征相交点154可以定义为遮挡路径142与线特征116或者线特征116的投影160之间的相交点。线特征116的投影160可以从起点156和终点158的每一个沿着线特征116的方向延伸。因此,在线特征116没有直接跟遮挡路径140、遮挡路径142或者两者相交的实施例中,投影160可以延伸至与遮挡路径140、遮挡路径142或者两者相交。另外值得注意的是,尽管遮挡路径140和遮挡路径142被描述成线段,但是如所描述的,遮挡路径140和遮挡路径142可以根据需要被延伸足够长以建立第一特征相交点152和第二特征相交点154。相应的,遮挡路径140可以沿着起于传感器原点32并指向线特征116的第一特征相交点152的方向148对齐,并且遮挡路径142可以沿着起于传感器原点32并指向线特征116的第二特征相交点154的方向150对齐。

地图数据120里面的线特征116和遮挡125的各种布置可以根据第一特征相交点152和第二特征相交点154来进行归类。图6D描绘了一些示例性归类方案以用于传感器原点32,遮挡125的起点144以及第一特征相交点152的布置。特别的,可以根据传感器原点32,遮挡125的起点144和第一特征相交点152沿着方向148的顺序进行归类。当遮挡125的起点144沿着方向148首先出现时,也就是说,起点144出现在传感器原点32和第一特征相交点152之前的时候,第一特征相交点152可以被归类为后部162。当遮挡125的起点144处于分隔传感器原点32和第一特征相交点152的空间中时,第一特征相交点152可以被归类为中间164。当遮挡125的起点144沿着方向150最后出现时,也就是说,起点144出现在传感器原点32和第一特征相交点152的后面时,第一特征相交点152可以被归类为超出166。参见图6A-图6C,上面描述的关于沿着方向148取的第一特征相交点152、传感器原点32、遮挡125的起点144的分类方式也可以以基本上相同的方式用于第二特征相交点154的分类,其利用传感器原点32,遮挡125的终点146以及方向150。

如下描述了作为本文实施例的非限制性示例的多种遮挡计算情况。在不脱离本文实施例的情况下,每一种情况可以按照任意的顺序实施。另外,在不脱离本公开范围的情况下,这些情况中的任一可以省略。然而,值得注意的是,申请人发现一种降低计算成本方法,也即,相同硬件较少计算时间,这可以通过按先后顺序执行本文描述的情况的遮挡计算以确定特征110的可见性来实现。

同时参考图4和图7A-7B,示意性描绘了可以由遮挡计算处理210来评估的第一种情况。在第一种情况中,线特征116可以与已经被归类为后部162的第一特征相交点152和被归类为后部162的第二特征相交点154相关联(如图7A)。备选的或附加的,线特征116可以与已经被归类为超出166的第一特征相交点152和被归类为超出166的第二特征相交点154相关联(如图7B)。在第一特征相交点152和第二特征相交点154被归类为第一种情况的实例的实施例中,线特征116位于第一特征相交点152和第二特征相交点154之间的部分可以被确定为可见132。在最终做出关于可见性的确定之后,方法200可以从遮挡计算处理210前进到叠加处理214。或者,如果线特征116与第一种情况不匹配,则遮挡计算处理210可以前进到第二种情况。

同时参考图4和图8A-8C,示意性描绘了可以由第一案例后续的遮挡计算处理210评估的第二种情况。在第二种情况中,线特征116可以与已经被归类为中间164的第一特征相交点152和被归类为中间164的第二特征相交点154相关联。在第一特征相交点152和第二特征相交点154被归类第二种情况的实例的实施例中,线特征116位于第一特征相交点152和第二特征相交点154之间的部分可以被确定为被遮挡130(如图8A和8B)。线特征116没有位于第一特征相交点152和第二特征相交点154之间的部分可以被确定为可见132,这可能包括部分(如图8B)或全部(如图8C)的线特征116。在最终做出线特征116相对于遮挡125的可见性的确定之后,方法200可以从遮挡计算处理210前进到叠加处理214。或者,如果线特征116与第二种情况不匹配,则遮挡计算处理210可以前进到第三种情况。

现在参考图4和图9A-9C,在一些实施例中,遮挡计算处理210可以配置用来特征化线特征116和遮挡125之间的关系。例如,特征路径170,特征路径172,或者二者同时可以被用来特征化线特征116。特征路径170和特征路径172的每一个可以延伸穿过线特征116和EBL传感器30的传感器原点32。在一些实施例中,特征路径170可以与线特征116相交于起点156,并且特征路径172可以与线特征116相交于终点158。

第三种情况可以经由特征路径170和特征路径172、由第二种情况后续的遮挡计算处理210来评估。特别的,当遮挡125同时与特征路径170和特征路径172相交时,线特征116可以被确定为被遮挡130。对于与第三种情况匹配且被确定为被遮挡130的线特征116,方法200可以从遮挡计算处理210前进到叠加处理214。或者,如果线特征116与第三种情况不匹配,遮挡计算处理210可以前进到第四种情况。值得注意的是,对于第三种情况后续的情况,遮挡125可以被假定为与线特征116或线特征116的投影160相交。

同时参考图4和图10A-10C,示意性描绘了可以由第三种情况后续的遮挡计算处理210来评估的第四种情况。在第四种情况中,特征-遮挡相交点174可以由线特征116的投影160和遮挡125(如图10A和10B)或者遮挡125的投影176(如图10C)组成。相应的,特征-遮挡相交点174不会直接与线特征116相交,即特征-遮挡相交点174不会落入特征路径170和特征路径172内。另外,在第四种情况中,遮挡125不会与特征路径170和特征路径172同时相交。对于与第四种情况匹配的线特征116,线特征116可以被归类为可见132,并且方法200可以从遮挡计算处理210前进到叠加处理214。或者,如果线特征116与第四种情况不匹配,则遮挡计算处理210可以前进到第五种情况。

同时参考图4和图11A-11D,示意性描绘了可以由第四种情况后续的遮挡计算处理210来评估的第五种情况。在第五种情况中,可以形成特征-遮挡相交点174,第一特征相交点152可以被归类为中间162,并且第二特征相交点154可以被归类为超出166(如图11A-11C)。相应的,线特征116位于第一特征相交点152和特征-遮挡相交点174之间的部分可以被归类为被遮挡130。线特征116的剩余部分可以被归类为可见132。备选的或附加的,第五种情况可以包含这样的布置:可以形成特征-遮挡相交点174,第一特征相交点152可以被归类为超出166,并且第二特征相交点154可以被归类为中间164(如图11D)。这样,线特征116位于特征-遮挡相交点174和第二特征相交点154之间的部分可以被归类为被遮挡130。线特征116的剩余部分可以被归类为可见132。在把线特征116归类为被遮挡130和可见132之后,方法200可以由遮挡计算处理210前进到叠加处理214。或者,如果线特征116与第五种情况不匹配,则遮挡计算处理210可以前进到第六种情况。

同时参考图4和图12A-12B,示意性描述了可以由第五种情况后续的遮挡计算处理210评估的第六种情况。在第六种情况中,第一特征相交点152可以被归类为中间164且第二特征相交点154可以被归类为后部162(如图12A),或者第一特征相交点152可以被归类为后部162且第二特征相交点154可以被归类为中间164(如图12B)。对于与第六种情况匹配的线特征116,线特征116从被归类为中间164的特征相交点开始到遮挡125一侧的部分可以被归类为被遮挡130。线特征116的剩余部分可以被归类为可见132。特别的,如图12A所示,线特征116从起点156到第一特征相交点152的部分可以被归类为可见132,线特征116从第一特征相交点152到终点158的部分可以被归类为被遮挡130。类似的,如图12B所示,线特征116从起点156到第二特征相交点154的部分可以被归类为被遮挡130,线特征116从第二特征相交点154到终点158的部分可以被归类为可见132。在把线特征116归类为被遮挡130和可见132之后,方法200可以由遮挡计算处理210前进到叠加处理214。或者,如果线特征116与第六种情况不匹配,遮挡计算处理210可以前进到第七种情况。

同时参考图4和图13A-13B,示意性描绘了可以由第六种情况后续的遮挡计算处理210评估的第七种情况。在第七种情况中,可以形成特征-遮挡相交点174,第一特征相交点152可以被归类为超出166,并且第二特征相交点154可以被归类为后部162。备选的或附加的,在第七种情况中,可以形成特征-遮挡相交点174,第一特征相交点152可以被归类为后部162,第二特征相交点154可以被归类为超出166。对于与第七种情况匹配的线特征116,线特征116位于特征-遮挡相交点174和被归类为后部162的特征相交点之间的部分可以被归类为可见132。线特征116的剩余部分,其可以定义为从特征-遮挡相交点174到遮挡125一侧的区域,可以被归类为被遮挡130。特别的,如图13A所示,线特征116从起点156到特征-遮挡相交点174的部分可以被归类为可见132,线特征116从特征-遮挡相交点174到终点158的部分可以被归类为被遮挡130。类似的,如图13B所示,线特征116从起点156到特征-遮挡相交点174的部分可以被归类为被遮挡130,线特征116从特征-遮挡相交点174到终点158的部分可以被归类为可见132。执行对应于第七种情况的遮挡计算之后,方法200可以前进到叠加步骤214。

同时参考图1、图2和图4,方法可以包括叠加处理214,其可以被配置用来迭代访问与可检测遮挡集合128相关联的遮挡125以确定对可见性的累积影响。特别的,叠加处理214可以确定与可检测特征集合126相关联的特征110是否已被确定为可见132或被遮挡130。如果特征110被确定为不可见,即被遮挡130,方法200前进到处理216,其操作以排除被确定为被遮挡130的特征110在定位中使用。例如,确定为被遮挡130的特征110的实例可以从可见特征列表134中被移除或省略。如果特征110的任何一部分被确定为可见132,即特征110至少部分可见,则方法200可以跳转到遮挡循环处理208以考虑可检测遮挡集合128的任何未被访问的实例。相应的,方法200可以考虑多个遮挡112对特征110可见性的影响。

同时参考图1和图14A-14C,多个遮挡112的影响可以通过叠加来确定。在一些实施例中,遮挡112可以与地图数据120中第一遮挡50和第二遮挡52对应,并且特征110可以与地图数据120中第一线特征54和第二线特征56对应。第一线特征54和第二线特征56中任一个的可见性取决于第一遮挡50和第二遮挡52的综合影响。特别的,当单独考虑第一遮挡50和第二遮挡52时,第一线特征54和第二线特征56中的任一个可能至少是部分可见的,但是当综合考虑第一遮挡50和第二遮挡52时,第一线特征54和第二线特征56中任一个可能被完全遮挡。特征110的可见区域可以针对每个遮挡112而跟踪并且合并以确定所有遮挡112的综合影响。

遮挡112的综合影响可以通过比较被截断的视场40(如图14A),第一被截断的视场42(如图14B)和第二被截断视场44(如图14C)来理解。被截断的视场40描绘了第一遮挡50和第二遮挡52对于第一线特征54和第二线特征56的可见性的影响。特别的,第一线特征54是部分可见的,即第一线特征54的一部分为可见132且第一线特征54的一部分为被遮挡130,并且第二线特征56为被遮挡130。被截断的视场40和第一线特征54之间的重叠可以定义第一线特征54中被归类为可见132的部分。

考虑第一遮挡50和第二遮挡52的综合影响时第一线特征54被归类为可见132的部分在单独考虑第一遮挡50和第二遮挡52的每一个时也被归类为可见132。如图14A-14C所描述的实施例,遮挡112对可见性的综合影响可以类似于逻辑“与”运算,即:如果特征110的一部分在第一被截断的视场42(如图14B)和第二被截断视场44(如图14C)中均被归类为可见132,那么特征110的这一部分可以被归类为可见132。类似的,遮挡112的综合影响可以类似于逻辑“或”运算,即:如果特征110的一部分在第一被截断的视场42(如图14B)或第二被截断视场44(如图14C)中被归类为被遮挡130,那么特征110的这一部分可以被归类为被遮挡130。相应的,遮挡112可以单独分别考虑,所有遮挡112的综合影响可以使用用于叠加的逻辑运算来综合。如上所述,如果在考虑多个遮挡112之后,特征110不存在可见区域,则与特征110对应的特征集合122中的实例可以被确定为被遮挡130并且可以从定位和导航中删除。

同时参考图2、图4、图12A和图15,遮挡计算处理210可以执行遮挡计算以特征化特征110和遮挡112之间的关系。在一些实施例中,遮挡计算处理210可以根据计算方法220来对特征110归类。计算方法220可以由处理222开始,其可以执行遮挡计算以特征化起点144和遮挡路径140。特别的,处理222可以确定与遮挡路径140相关联的起点144是否位于特征路径170和特征路径172内,即以线特征116,特征路径170和特征路径172为边界构成的大体三角形区域所界定。如果起点144位于特征路径170和特征路径172内(例如图12A),则计算方法220可以跳转到处理224。如果起点144没有位于特征路径170和特征路径172内(例如图12B),计算方法220可以跳转到处理226。值得注意的是,在图15中,肯定条件通常用“Y”表示,否定条件通常用“N”表示。

同时参考图8B、图12B和图15,处理224可以执行遮挡计算以特征化终点146和遮挡路径142。特别的,处理224可以确定与遮挡路径142相关联的终点146是否位于特征路径170和特征路径172内。如果终点146位于特征路径170和特征路径172内(例如图12B),计算方法220可以将线特征116归类为具有分裂遮挡228。相应的,线特征116位于第一特征相交点152和第二特征相交点154之间的部分可以被确定为被遮挡130(如图8B)。如果终点146没有位于特征路径170和特征路径172内(例如图12A),计算方法220可以跳转到处理230。

同时参考图11C、图12A和图15,步骤230可以执行遮挡计算以特征化遮挡125和特征路径172。特别的,处理230可以确定遮挡125是否与特征路径172相交,其在图11C和图12A中被描绘为位于右侧。如果遮挡125与特征路径172相交,计算方法220可以将线特征116归类为具有部分遮挡232(如图12A)。相应的,线特征116从起点156到第一特征相交点152的部分可以被归类为可见132,并且线特征116从第一特征相交点152到终点158的部分可以被归类为被遮挡130。如果遮挡125没有与特征路径172相交,计算方法220可以将线特征116归类为具有相交分裂遮挡234(如图11C)。相应的,线特征116位于特征-遮挡相交点174和被归类为中间164的特征相交点之间的部分可以被归类为被遮挡130。线特征116的其余部分可以被归类为可见132。

同时参考图12B、图13A和图15,计算方法220可以包括处理226,其可以在处理222之后被执行,例如当处理222的条件不满足时。处理226可以执行遮挡计算以确定与遮挡路径142相关联的终点146是否位于特征路径170和特征路径172内。如果终点146位于特征路径170和特征路径172内(例如图12B),计算方法220可以跳转到处理236。如果终点146没有位于特征路径170和特征路径172内(例如图13A),计算方法220可以跳转到处理238。

同时参考图7A、图7B、图8A和图15,备选的或附加的,处理226可以执行遮挡计算以检查第一特征相交点152和第二特征相交点154的归类。特别的,如果第一特征相交点152和第二特征相交点154同时被归类为后部162(如图7A),计算方法220可以将线特征116归类为没有遮挡240。如果第一特征相交点152和第二特征相交点154同时被归类为超出166(如图7B),计算方法220可以将线特征116归类为没有阻挡240。如果第一特征相交点152和第二特征相交点154同时被归类为中间164和内部(如图8A),计算方法220可以将线特征116归类为全遮挡242。

同时参考图11D、图12B和图15,处理226后续的处理236可以执行遮挡计算以特征化遮挡125和特征路径170。特别的,处理236可以确定遮挡125是否和特征路径170相交,其在图11D和图12B被描绘为位于左侧。如果遮挡125和特征路径170相交,计算方法220可以将线特征116归类为具有部分遮挡232(如图12B),并且线特征116的可见性可以按上述方法确定。如果遮挡125不与特征路径170相交,计算方法220可以将线特征166归类为具有相交分裂遮挡234(如图11D),并且线特征116的可见性可以按上述方法确定。

同时参考图13A、图13B和图15,计算方法220可以包括处理238,其可以在处理226之后执行,例如当处理226的条件判定为否时。处理238可以确定遮挡125是否和特征路径170相交,器在图13A被描绘为位于左侧。如果遮挡125和特征路径170相交(例如图13A),计算方法220可以跳转到处理244。如果遮挡125不和特征路径170相交(例如图13B),计算方法220可以跳转到处理246。

同时参考图9A、图13B和图15,处理244可以执行遮挡计算以确定遮挡125是否和特征路径172相交,其在图9A和图14B被描绘为位于右侧。如果遮挡125与特征路径172相交,计算方法220可以将线特征116归类为具有全遮挡242(如图9A)。如果遮挡125不与特征路径172相交,计算方法220可以将线特征116归类为具有相交部分遮挡248(如图13B)。相应的,线特征116从起点156到特征-遮挡相交点174的部分可以被归类为被遮挡130,线特征116从特征-遮挡相交点174到终点158的部分可以被归类为可见132。

同时参考图13A和图15,处理246可以执行遮挡计算以确定遮挡125是否和特征路径172相交,其在图13A被描绘为位于右侧。如果遮挡125与特征路径172相交,计算方法220可以将线特征116归类为具有相交部分遮挡248(如图13A)。相应的,线特征116从起点156到特征-遮挡相交点174的部分可以被归类为可见132,线特征116从特征-遮挡相交点174到终点158的部分可以被归类为被遮挡130。如果遮挡125不与特征路径170相交,计算方法220可以将线特征116归类为没有阻挡240。

同时参考图2、图4和图16,遮挡计算处理210可以执行遮挡计算以特征化特征110和遮挡125之间的关系。遮挡计算处理210可以利用多种归类方案,包括但不限于计算方法250,来归类特征110的可见性。值得注意的是,在图16中,肯定条件通常用“Y”表示,否定条件通常用“N”表示。

同时参考图9A、图10A和图16,计算方法250可以从处理252开始,其可以执行遮挡计算以特征化遮挡125和特征路径170。特别的,处理252可以确定遮挡125是否与特征路径170相交,其在图9A和图10A被描绘为位于左侧。如果遮挡125与特征路径172相交(例如图9A),计算方法250可以跳转到处理254。如果遮挡125不与特征路径172相交(例如图10A),计算方法250可以跳转到处理256。

同时参考图9A,图12B和图16,处理254可以执行遮挡计算以确定遮挡125是否与特征路径172相交,其在图9A和图12B被描绘为位于右侧。如果遮挡125与特征路径172相交(例如图9A),线特征116可以被归类为全遮挡242。如果遮挡125不与特征路径172相交(例如图12B),计算方法250可以跳转到处理258。

同时参考图12B,13B和图16,处理258可以执行遮挡计算以确定与遮挡路径142相关联的终点146是否位于特征路径170和特征路径172内。如果终点146位于特征路径170和特征路径172内(例如图12B),计算方法220可以将线特征116归类为具有部分遮挡232。相应的,线特征116从起点156到第一特征相交点152之间的部分可以被确定为被遮挡130,线特征116的剩余部分可以被归类为可见132。如果终点146没有位于特征路径170和特征路径172内(例如图13B),线特征116可以被归类为具有相交部分遮挡248。线特征116的可见性可以如上文针对图13B所描述的被归类。

同时参考图11D、图13A和图16,处理256可以在处理252判断为否定条件之后执行。处理256可以执行遮挡计算以确定遮挡125是否与特征路径172相交,其在图11D和图13A被描绘为位于右侧。如果遮挡125与特征路径172相交(例如图13A),计算方法250可以跳转到处理260。如果遮挡125不与特征路径172相交(例如图11D),计算方法250可以跳转到处理258。

同时参考图12A,图13A和图16,处理260可以执行遮挡计算以确定与遮挡路径140相关联的起点144是否位于特征路径170和特征路径172内。如果起点144位于特征路径170和特征路径172内(例如图12A),线特征116可以被归类为部分遮挡232。相应的,线特征116的可见性可以如上文针对图12A所描述的被归类。如果起点144没有位于特征路径170和特征路径172内(例如图13A),线特征116可以被归类为相交部分遮挡248。相应的,线特征116的可见性可以如上文针对图13A所描述的被归类。

同时参考图11C、图11D和图16,处理262可以在处理256被判定为否定之后执行。处理262可以执行遮挡计算以确定与遮挡路径140相关联的起点144是否位于特征路径170和特征路径172内。如果起点144位于特征路径170和特征路径172内(例如图11C),计算方法250可以跳转到处理264。如果起点144没有位于特征路径170和特征路径172内(例如图11D),计算方法250可以跳转到处理266。

同时参考图8B,图11C和图16,处理264可以执行遮挡计算以确定与遮挡路径142相关联的终点146是否位于特征路径170和特征路径172内。如果终点146位于特征路径170和特征路径172内(例如图8B),计算方法220可以将线特征116归类为具有分裂遮挡228。相应的,线特征116的可见性可以如上文针对图8B所描述的被归类。如果终点146没有位于特征路径170和特征路径172内(例如图11C),线特征116可以被归类为相交分裂遮挡234。线特征116的可见性可以如上文针对图11C所描述的被归类。

同时参考图7A,图11D和图16,处理266可以在处理262被判定为否定条件之后执行。处理266可以执行遮挡计算以确定与遮挡路径142相关联的终点146是否位于特征路径170和特征路径172内。如果终点146位于特征路径170和特征路径172内(例如图11D),计算方法220可以将线特征116归类为具有相交分裂遮挡234。相应的,线特征116的可见性可以如上文针对图11D所描述的被归类。如果终点146没有位于特征路径170和特征路径172内(例如图7A),线特征116可以被归类为没有遮挡240。

再次参考图4,本文描述的实施例涉及用于执行遮挡计算处理210的多个方法。正如上面所指出来的,在不脱离本公开范围的情况下,遮挡计算的顺序和类别可以有多种变化。事实上,申请人已经发现当使用基于遮挡计算数量的成本启发法来组织遮挡计算处理210时,本文描述的实施例可以以降低计算成本的方式实施。

同时参考图2、图15和图16,计算方法220和计算方法250用一种成本启发法来评估。特别的,每个遮挡类别被分配一个基于将特征110归类为具有特定遮挡类型所需的遮挡计算数量的启发式成本。工业设施100在一段使用周期上被评估以确定识别每个遮挡类型的时间比例。时间比例乘以启发式成本以确定计算方法220和计算方法250的有效启发式成本。结果总结于下表1。

表1

如表1所示,计算方法220与计算方法250相比,减少了计算成本。特别的,计算方法220显示每个遮挡/特征对需大约2.63遮挡计算的有效启发式成本,相较于计算方法250的每个遮挡/特征对需大约3.57遮挡计算的有效启发式成本。值得注意的是,在具有不同比例混合的遮挡类别的环境下,计算方法250表现得更加有效。相应的,有效启发式成本可以被用来针对任意特定的工业设施100定制本文描述的实施例。

现在应该被理解的是,本文描述的实施例涉及可以利用可见特征以及排除被遮挡特征来执行定位和导航的系统、方法以及工业车辆。特别的,本文描述的实施例可以根据工业车辆的传感器的当前位置动态更新特征的可见性。相应的,定位和导航功能可以运行对地图数据子集和可能被传感器检测的特征进行比较。定位和导航功能的准确性可以通过减小地图数据和被遮挡特征之间可能的不匹配数量而得以改善。此外,定位和导航功能的处理时间可以通过从考虑因素中排除被遮挡特征来改善,这可以减少定位和导航功能需要收敛到一个解的时间量。

值得注意的是,这里应用的词语“大体上”用来表示可以归因为任何定量比较,评价,测量或其他表示的不确定性的内在程度。这个术语也用来表示一个定量表示可以在规定的参考内变化的程度,这个变化不会导致所讨论问题基本功能的变化。

此外,值得注意的是为了清晰而不是限制的目的,提供有方向的参考系,例如X轴,Y轴,Z轴等等。特别的,请注意本文的实施例参考二维坐标系统来描述。为了清晰而不是限制的目的,可以提供针对坐标系统的任何描述。这样,本文的实施例可以通过对所提供的坐标系做出相应的变化来扩展到更高或更低阶的坐标系。

以上以特定实例进行解释和描述,但应当理解,在不脱离请求保护主题的精神和范围的情况上,可以进行其他变化和修改。另外,尽管本文描述了请求保护主题的诸多方面,但这些方面不需同时综合使用。由此旨在于由所附权利要求覆盖所有这些不脱离请求保护主题的范围的变化和修改。另外,值得注意的是,权利要求中使用的语句“一个或多个处理器执行机器可读指令以”用作开放式过渡,因而语句里面的“以”等同于“包括”一词。

去获取专利,查看全文>

相似文献

  • 专利
  • 中文文献
  • 外文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号