CN114119759B - 多位置机动车定位方法和装置、电子设备和存储介质 - Google Patents

多位置机动车定位方法和装置、电子设备和存储介质 Download PDF

Info

Publication number
CN114119759B
CN114119759B CN202210106791.0A CN202210106791A CN114119759B CN 114119759 B CN114119759 B CN 114119759B CN 202210106791 A CN202210106791 A CN 202210106791A CN 114119759 B CN114119759 B CN 114119759B
Authority
CN
China
Prior art keywords
positions
feature point
estimated current
determining
distances
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
CN202210106791.0A
Other languages
English (en)
Other versions
CN114119759A (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.)
Hangzhou Hongjing Zhijia Technology Co ltd
Original Assignee
Hangzhou Hongjing Zhijia 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 Hangzhou Hongjing Zhijia Technology Co ltd filed Critical Hangzhou Hongjing Zhijia Technology Co ltd
Priority to CN202210106791.0A priority Critical patent/CN114119759B/zh
Publication of CN114119759A publication Critical patent/CN114119759A/zh
Application granted granted Critical
Publication of CN114119759B publication Critical patent/CN114119759B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/70Determining position or orientation of objects or cameras
    • G06T7/73Determining position or orientation of objects or cameras using feature-based methods
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T17/00Three dimensional [3D] modelling, e.g. data description of 3D objects
    • G06T17/05Geographic models
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/20Analysis of motion
    • G06T7/277Analysis of motion involving stochastic approaches, e.g. using Kalman filters

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Geometry (AREA)
  • Software Systems (AREA)
  • Multimedia (AREA)
  • Remote Sensing (AREA)
  • Computer Graphics (AREA)
  • Navigation (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

本发明涉及多相机机动车定位方法和装置、电子设备和存储介质。该方法包括:S100:确定m个在预定的范围内的推定当前位置;S200:在机动车运动过程中,利用相机在n个轨迹位置获得图片;S300:并取得各图片中特征点的地图位置;针对各推定当前位置,进行S400‑S700,获得m个匹配距离:S400:依据对应运动轨迹,确定n个相机位置;S500:针对各所述特征点,分别获取基于各特征点的n个特征点向量;S600:计算该特征点的地图位置到其对应的特征点向量的距离,从而获得n个距离;S700:根据该n个距离,确定匹配距离;以及步骤S800,根据所述m个匹配距离确定匹配度,确定为当前位置。

Description

多位置机动车定位方法和装置、电子设备和存储介质
技术领域
本发明涉及机动车定位。
背景技术
视觉定位是目前已知硬件成本最低的室内定位方案。目前已经在地下车库定位、地下通道定位等上得到了应用。但是视觉定位有时定位不精确,定位抖动大。
发明内容
本发明鉴于现有技术的以上问题作出,用以解决现有技术中存在的一项或更多项的问题。
根据本发明的一个方面,提供了一种多位置图片机动车定位方法,所述机动车安装有相机,所述方法包括以下的步骤:S100:确定m个推定当前位置,所述m个推定当前位置在预定的范围内,m是大于1的正整数;S200:在所述机动车运动过程中,利用所述相机在所述机动车实际运动轨迹上的n个轨迹位置获得图片,从而得到n张图片,所述n个轨迹位置的测量间隔在运动位置推算算法的精度范围内,所述运动位置推算算法用于在机动车运动过程中推算机动车的位置,n为大于1的整数;S300:在各所述图片中获得特征点,并取得该特征点在三维地图中的位置,即该特征点的地图位置;针对所述m个推定当前位置中的各推定当前位置,进行步骤S400到步骤S700的处理,获得m个匹配距离:S400:依据该推定当前位置的对应运动轨迹,确定机动车在所述n个轨迹位置时,所述相机的位置,从而获得n个相机位置;S500:针对各所述特征点,利用所述n个相机位置,分别获取基于各特征点的特征点向量,从而得到n个特征点向量,所述特征点向量是相机到对应特征点的向量;S600:计算该特征点的地图位置到其对应的特征点向量的距离,从而获得n个距离;S700:根据该n个距离,确定该推定当前位置的匹配距离;所述方法还包括步骤S800,根据所述m个匹配距离确定匹配度,将匹配度最高的推定当前位置,确定为当前位置。
依据一种实施方式,所述匹配距离是取所述n个距离的平均值或和值。
依据一种实施方式,所述步骤S100包括如下的步骤:设定起始点位置,所述起始点位置所在的位置范围是已知的;在该起始点位置周围一定的范围内随机生成多个虚拟位置;在机动车运动时,利用扩展卡尔曼滤波(EKF)算法推定运动后的所述起始点位置和所述多个虚拟位置;将推定出的运动后的所述起始点位置和所述多个虚拟位置的当前位置设定为所述推定当前位置。
根据本发明的另一个方面,提供了一种多位置机动车定位装置,用于机动车,所述机动车安装有相机。所述多位置机动车定位装置包括:推定当前位置确定单元,用于确定m个推定当前位置,所述m个推定当前位置在预定的范围内,m是大于1的正整数;图片获取单元,在所述机动车运动过程中,利用所述相机在所述机动车实际运动轨迹上的n个轨迹位置获得图片,从而得到n张图片,所述n个轨迹位置的测量间隔在运动位置推算算法的精度范围内,所述运动位置推算算法用于在机动车运动过程中推算机动车的位置,n为大于1的整数;特征点获取单元,用于在各所述图片中获得特征点,并取得该特征点在三维地图中的位置,即该特征点的地图位置;匹配距离获得单元,用于针对所述m个推定当前位置中的各推定当前位置,根据各推定当前位置的运动轨迹,获得m个匹配距离;当前位置确定单元,用于根据所述m个匹配距离确定匹配度,将匹配度最高的推定当前位置,确定为当前位置,针对各推定当前位置,匹配距离获得单元如下地获取其匹配距离:确定该推定当前位置的对应运动轨迹,并根据该运动轨迹确定在所述n个轨迹位置的各轨迹位置时,假定机动车处于对应于该推定当前位置的情况下相机的位置,从而获得n个相机位置;针对各所述特征点,利用所述n个相机位置,分别获取基于各特征点的特征点向量,从而得到n个特征点向量,所述特征点向量是相机到对应特征点的向量;计算该特征点的地图位置到其对应的特征点向量的距离,从而获得n个距离;根据该n个距离,确定该推定当前位置的匹配距离。
根据本发明的一个方面,提供了一种电子设备,包括:处理器;用于存储所述处理器可执行指令的存储器;其中,所述处理器被配置为执行所述指令,以实现本发明的方法。
根据本发明的一个方面,提供了一种计算机可读存储介质,所述可读存储介质上存储设备控制程序,当所述设备控制程序被处理器执行时,实现本发明所述的方法。
根据本发明的实施方式,能够提供定位精度和减小定位抖动。
附图说明
结合附图可以更好地理解本发明。附图只是示意性的,不是对本发明的保护范围的限制。
图1示出了依据本发明的一种实施方式的多相机机动车定位方法的示意性流程图。
图2示出了依据本发明的一种实施方式的获得推定当前位置的一种示意性方法。
图3用于解释特征点向量的示意图。
图4示出了依据一种实施方式如何确定一个特征点到其特征点向量的距离的示意图。
图5示出了依据本发明的另一实施方式的多位置机动车定位装置的示意性方框图。
具体实施方式
下面结合附图对本发明的具体实施方式进行说明。这些说明都是示例性的,旨在使本领域技术人员能够实现本发明的实施方式,不是对本发明的保护范围的限制。说明中也没有描述对于实际实施不可缺少,但是对于理解本发明无关的内容。
图1示出了依据本发明的一种实施方式的多位置机动车定位方法的示意性流程图。本发明的方法所涉及的机动车具有相机,该相机能够拍摄周围环境的图像。
如图1所示,依据本发明的一种实施方式的多位置机动车定位方法,首先在步骤S100,确定m个推定当前位置,m是大于1的正整数。所述m个推定当前位置在预定的范围内。
该m个推定的当前位置可以基于已知的初始位置,也可以基于上一周期的位置而利用EKF算法(扩展卡尔曼滤波算法)结合车辆的运动信息(ABS信号和惯导)推算出的运动轨迹位置。在启动时,不知道车辆的具体位置,但是知道车辆的大概位置,这个大概的位置即初始位置。该大概位置的范围是本发明的预定的范围的一个示例。启动时的车辆的停靠位置(例如车位)是已知的,并且已知该位置在地图坐标系中的坐标,可以利用这个坐标来确定该初始位置(例如图2中的作为起始点的车辆推定当前位置)。
这个初始的位置(例如人工随意停在这个位置的时候)会有一定误差。该位置误差例如大概在1-2米,航向误差大概5度。在运动时,利用EKF算法(扩展卡尔曼滤波算法)结合车辆的运动信息(ABS信号和惯导)去推算。推算出的位置也有一定的误差,该误差的范围可以根据EKF的协方差和方差来生成。根据一种实施方式,xy方向上的方差和协方差可以计算出误差椭圆。基于该初始位置或运动轨迹位置,在初始位置或运动轨迹位置的误差范围内,随机地或依据一定的函数关系,生产多个推定当前位置。由于推定当前位置有多个,均在误差的范围内,因而这些推定当前位置中会包含真实的当前位置。各推定当前位置具有平面坐标和航向。该初始位置或运动轨迹位置及其误差范围是本发明的预定的范围的示例。
图2示出了依据本发明的一种实施方式的获得推定当前位置的方法。如图2所示,根据本发明的一种实施方式,首先,人为设定一个起始点(A点),该起始点所在的位置范围是已知的。起始点位置包括车辆的位置和航向。如上所述,这个起始点例如是车辆启动时的车位位置等,只知道该起始点(作为起始点的推定当前位置)的位置范围,而无需知道其精确范围。但是本发明并不排除知道其具体位置的情况。
然后,在该起始点周围一定的范围内随机生成虚拟位置(推定当前位置),这些虚拟位置包括车辆的位置和航向。本领域的技术人员容易理解,这里虽然说是虚拟,但是由于假定的起始位置并不精确,因而这些虚拟的、推定的位置也有可能才是最真实的位置。可以将起始点位置和推定位置这些车辆位置都称为A点位置。例如预期当在初始位置的位置误差在1-2米,航向误差在5度的情况下,这里推定位置的点云的范围可以是该推定的当前位置周围2-2.5米范围,航向10度范围。或者在非初始位置,推定位置的点云的范围是误差椭圆2倍的范围。
然后,如图2所示,在一定的时间间隔之后,到达了B点,根据EKF算法或其他的算法,获知这些车辆位置(A点位置)到达B点时的位置(B点位置,既车辆运动后的位置),将这些位置设定为推定的当前位置。
然后,在步骤S200,在所述机动车运动过程中,利用相机在机动车实际运动轨迹上的n个轨迹位置获得图片,从而得到n张图片,所述n个轨迹位置的测量间隔在运动位置推算算法的精度范围内,运动位置推算算法用于在机动车运动过程中推算机动车的位置,n为大于1的整数。运动位置推算算法用于在机动车运动过程中推算机动车的位置。EKF算法是该运动位置推算算法的一种示例,但是本发明实施方式的运动位置推算算法可以采用现在已知的或未来知悉的各种算法完成。如上所述,随着时间的推移,运动位置推算算法(例如EKF算法)的误差会逐渐增加。因此,该n个轨迹位置的测量间隔应保证运动位置推算算法的误差小于预定的误差值,即,所述n个轨迹位置的测量间隔在运动位置推算算法的精度范围内。
根据一种实施方式,EKF在启动的时候需要一个位置和航向来确定位置和航向,接下来每次收到车辆纵向(ABS脉冲信号或者车速)或转向运动信息(陀螺仪产生的Z轴角速度),会根据上一时刻的位置和航向推算车辆位置和航向。即运动跟踪装置(例如EKF计算单元)每次收到车辆纵向运动信息或转向运动信息时,相机进行拍照,从而获得图片。根据另一种实施方式,周期性地进行位置和航向的修正。一般周期为1秒1-2次。也就是在低速场景下,车辆每行驶1-3米,就进行一次更新。可以在更新时进行拍照,从而获得照片。
接着在步骤S300,在各所述图片中获得特征点,并取得各特征点在三维地图中的位置,即特征点的地图位置。特征点是指相片中能够识别、并且在地图中具有坐标的点。可以预先在数据库中保存特征点的特征,进行对比识别。可以利用机器视觉的方法来识别特征点。可以人为地设置特征点,例如在墙壁或柱子的特定位置设置特定的图案或物品等。总之,可以利用现在已知或未来知悉的各种方法来识别特征点。
根据一种实施方式,利用距离图片中心在预定距离范围内的像素选取特征点。根据一种实施方式,特征点的大小大于预定值。例如,如果特征点是矩形,其宽度大于预定长度。利用这样的方式确定特征点,可以增加定位的准确性。
根据一种实施方式,利用环境信息识别照片中的特征点。例如在厂房的情况下,可以将设定的特征点全部按照固定的间距设置,可以利用这些环境信息,迅速在图片中确定特征点。
根据一种实施方式,依据推定当前位置的位置和航向,将车辆放在三维地图中,再根据车辆在三维地图中的位置和姿态,计算车辆能看到哪些三维图像中的特征点,从而可以获得各特征点在三维地图中的位置。
在一种实施方式中,一张照片中获得一个特征点,从而从该n张照片获得了n个特征点。
之后,针对该m个推定的当前位置中的各位置,执行一下的步骤S400-S700,从而获得m个匹配距离。
S400:依据该推定当前位置的对应运动轨迹,确定机动车在所述n个轨迹位置时,假定该机动车处于该推定当前位置的情况下,所述相机的位置,从而获得n个相机位置。
根据一种实施方式,利用EKF算法(扩展卡尔曼滤波算法)结合车辆的运动信息(ABS信号和惯导)推算车辆的运动轨迹位置,从而得到各推定当前位置的对应运动轨迹,并获得该运动轨迹上的多个位置。假定第一推定当前位置的车辆在第一时刻运动到第二时刻,位于C位置,对应地,第二推定当前位置的车辆在第一时刻运动到第二时刻,其处于D位置。这里C位置和D位置是有差别的,第一推定位置到C位置的轨迹可被称为第一推定位置的对应运动轨迹,第二推定位置到D位置的轨迹可被称为基于第二推定位置的对应运动轨迹。第一推定位置和C位置可以被称为第一推定位置的对应运动轨迹的位置点,第二推定位置和D位置可以被称为第二推定位置的对应运动轨迹的位置点。
根据机动车和相机的位置关系,可以获得机动车在各推定当前位置的运动轨迹上的位置点时相机的位置,对于一个推定当前位置,对照运动轨迹,可以与拍照位置对应地获得n个相机位置。
在步骤S500,针对各特征点,分别获取与之对应的特征点向量,从而得到n个特征点向量,该特征点向量是从相机(例如透镜焦点)到特征点的向量。
由于各推定当前位置具有航向,而各相机相对于该机动车的位置和方向都是已知的,因而可以获得相机的位置和朝向等信息。获得了该机动车在该推定当前位置时的相机位置和朝向,就可以很容易获得特征点向量。图3是用于解释特征点向量的示意图。图中的特征产生的向量即特征点向量。
然后,在步骤S600,计算各特征点的地图位置到基于该特征点的特征点向量的距离,从而可以获得n个距离。图4示意性地示出了如何确定一个特征点到其特征点向量的距离。从特征点的地图位置向该特征点的特征点向量(或其延长线)做垂线,该垂线的长度即距离。
本领域技术人员应该理解,尽管理论上特征点的地图位置和相机成像空间的位置应该是一致的,但是由于地图会有误差、相机的各种参数(包括相机的畸变参数、x轴焦距、y轴焦距、安装位置、横摆角、俯仰角、自旋角等)也有误差、车身的倾斜等,这两个位置也有可能会不重合。由于特征点向量是相机到相机成像空间中的特征点的连线,因而特征点的地图位置与特征点向量之间会产生距离。对于重合的情况,距离为0。不影响本发明的实施。
随后,在步骤S700,根据该n个距离,确定该推定当前位置的匹配距离。该匹配距离例如可以是取这n个距离的平均值或和值。
针对m个推定当前位置中剩余的推定当前位置,重复以上的步骤S400-S700,从而获得m个匹配距离。
然后,当完成了所有推定当前位置的匹配距离的计算时(
Figure DEST_PATH_IMAGE002
的判断结果为“是”),在步骤S800,根据该m个匹配距离确定匹配度,将匹配度最高的推定当前位置,确定为当前位置。在该匹配距离是取上述n个距离的平均值时,匹配距离越短,则匹配度越高。
本领域的技术人员应该理解,在步骤S100确定m个推定当前位置时,可以是一次性生成全部m个推定当前位置,也可以是生成一个就进行步骤S200-600的处理,然后在生成第二个,如此类推。这些都在本发明的这一步骤S100的范围内。
依据本发明的实施方式,不需要具有长度的特征物,降低了识别难度。无需使用多个相机,降低了成本。根据本发明的实施方式,也并不需要将二维平面的投影,简化了运算难度,可以提高运算速度。
根据本发明的一种实施方式,在步骤S400中,还包括进行特征筛选的步骤,剔除掉俯仰角低于预定阈值的特征点,特征点的俯仰角是指该特征点向量相对于所述机动车的水平位置平面的俯仰角。根据这一技术方案,能够剔除掉运动的特征(其他车辆)而保留固定的特征(建筑物),从而能够提高运算速度,增加定位精度。
进一步,可以将匹配度最优的推定当前位置作为起始位置,在该起始位置周围一定的范围内随机生成虚拟位置,就如结合图2所说明的那样,从而这些虚拟位置可以作为推定当前位置进行下一时刻的位置确定和轨迹生成。根据一种实施方式,可以将匹配度较差(低于预定阈值)最差的预定范围的推定当前位置去除,而保留的未去除的推定当前位置可以等到下一个相机匹配阶段开始时,根据车辆运动轨迹推断下一时刻的位置。如上所述,轨迹可以来自于ABS信号和惯导信号。
这样可以减少虚拟位置的生成数量,提高运算速度。去除时,例如去除匹配度低于平均匹配度的所有推定当前位置。
根据一种实施方式,在步骤S300,在各所述图片中获得多个特征点。例如k个特征点,k是大于1的正整数。在步骤S500中,针对所述n张图片中的各图片,分别获取k个特征点向量,从而在所述步骤S600中获得n*k个距离,在步骤S700中,所述匹配距离是取所述k*n个距离的平均值或和值,k是大于1的正整数。
根据一种实施方式,根据一种实施方式,所述特征点多于三个,而且任何特征点不在其他任何两个特征点的连线或连线的延长线上。依据这样的实施方式,可以提高定位的准确性。
图5示出了依据本发明的另一实施方式的多位置机动车定位装置的示意性方框图。依据本发明的一种实施方式的多位置机动车定位装置,用于机动车,所述机动车安装有相机。如图5所示,该多位置机动车定位装置包括推定当前位置确定单元100、图片获取单元200、特征点获取单元300、匹配距离获得单元400、当前位置确定单元。
推定当前位置确定单元100用于确定m个推定当前位置,所述m个推定当前位置在预定的范围内,m是大于1的正整数。图片获取单元200在机动车运动过程中,利用相机在所述机动车实际运动轨迹上的n个轨迹位置获得图片,从而得到n张图片,该n个轨迹位置的测量间隔在运动位置推算算法的精度范围内,该运动位置推算算法用于在机动车运动过程中推算机动车的位置,n为大于1的整数。特征点获取单元300用于在各图片中获得特征点,并取得该特征点在三维地图中的位置,即该特征点的地图位置。匹配距离获得单元400用于针对该m个推定当前位置中的各推定当前位置,根据各推定当前位置的运动轨迹,获得m个匹配距离。当前位置确定单元500,用于根据所述m个匹配距离确定匹配度,将匹配度最高的推定当前位置,确定为当前位置。
根据一种实施方式,匹配距离获得单元400如下地获取各推定当前位置的匹配距离:确定该推定当前位置的对应运动轨迹,并根据该运动轨迹确定在所述n个轨迹位置的各位置时,假定机动车对应于该推定当前位置的情况下,相机的位置,从而获得n个相机位置;针对各所述特征点,利用所述n个相机位置,分别获取基于各特征点的特征点向量,从而得到n个特征点向量,所述特征点向量是相机到对应特征点的向量;计算该特征点的地图位置到其对应的特征点向量的距离,从而获得n个距离;根据该n个距离,确定该推定当前位置的匹配距离。
依据一种实施方式,特征点获取单元300在各所述图片中获得多个特征点。例如k个特征点,k是大于1的正整数。在匹配距离获得单元400针对所述n张图片中的各图片,分别获取k个特征点向量,从而获得n*k个距离,所述匹配距离取所述k*n个距离的平均值或和值,k是大于1的正整数。
根据一种实施方式,所述特征点多于三个,而且任何特征点不在其他任何两个特征点的连线或连线的延长线上。依据这样的实施方式,可以提高定位的准确性。
本领域技术人员容易理解,可以利用以上对方法的说明来理解本发明的装置。
本领域技术人员容易理解,本发明的方法还可以包括与本发明的装置所完成的功能对应的其他步骤。以上的这些步骤也可以进行精简。
本发明对单元和步骤的标号仅仅是为了说明的方便,除非上下文中有相反的说明,否则不代表其执行的顺序。
本领域的技术人员应该理解,上述的各单元可以由软件或专门的硬件来实现,例如现场可编程门阵列、单片机、或微芯片等,或者也可以通过软件结合硬件的方式来实现。
本发明还提供了一种电子设备,包括:处理器;用于存储所述处理器可执行指令的存储器;其中,所述处理器被配置为执行所述指令,以实现本发明的方法。
本发明还涉及一种计算机软件,该计算机软件在被计算装置(例如单片机、电脑、CPU等)执行时,可以实现本发明的方法。
本发明还涉及一种计算机软件存储装置,例如硬盘、软盘、闪存等,该计算机软件存储装置存储有上述的计算机软件。
本发明对方法或步骤的说明可以用于理解对单元或装置的说明,对单元或装置的说明也可以用于理解本发明的方法或步骤。
以上说明仅仅是示意性的,不是对本发明的保护范围的限制,在本发明的权利要求范围内的任何改变、替换均在本发明的保护范围内。

Claims (9)

1.一种多位置机动车定位方法,所述机动车安装有相机,其特征在于,所述方法包括以下的步骤:
S100:确定m个推定当前位置,所述m个推定当前位置在预定的范围内,m是大于1的正整数;
S200:在所述机动车运动过程中,利用所述相机在所述机动车实际运动轨迹上的n个轨迹位置获得图片,从而得到n张图片,所述n个轨迹位置的测量间隔在运动位置推算算法的精度范围内,所述运动位置推算算法用于在机动车运动过程中推算机动车的位置,n为大于1的整数;
S300:在各所述图片中获得特征点,并取得该特征点在三维地图中的位置,即该特征点的地图位置;
针对所述m个推定当前位置中的各推定当前位置,进行步骤S400到步骤S700的处理,获得m个匹配距离:
S400:确定该推定当前位置的对应运动轨迹,并根据该运动轨迹确定在所述n个轨迹位置的各轨迹位置时,假定机动车处于对应于该推定当前位置的情况下,所述相机的位置,从而获得n个相机位置;
S500:针对各所述特征点,利用所述n个相机位置,分别获取基于各特征点的特征点向量,从而得到n个特征点向量,所述特征点向量是相机到对应特征点的向量;
S600:计算该特征点的地图位置到其对应的特征点向量的距离,从而获得n个距离;
S700:根据该n个距离,确定该推定当前位置的匹配距离;
所述方法还包括步骤S800,根据所述m个匹配距离确定匹配度,将匹配度最高的推定当前位置,确定为当前位置,
其中,所述步骤S100包括如下的步骤:
设定起始点位置,所述起始点位置所在的位置范围是已知的;
在该起始点位置周围一定的范围内随机生成多个虚拟位置;
在机动车运动时,利用扩展卡尔曼滤波算法推定运动后的所述起始点位置和所述多个虚拟位置;
将推定出的运动后的所述起始点位置和所述多个虚拟位置的当前位置设定为所述推定当前位置。
2.根据权利要求1所述的方法,其特征在于,所述匹配距离是取所述n个距离的平均值。
3.根据权利要求1所述的方法,其特征在于,利用距离图片中心在预定距离范围内的像素选取特征点。
4.根据权利要求1所述的方法,其特征在于,所述特征点的大小大于预定值。
5.根据权利要求1所述的方法,其特征在于,利用设定的特征点的间距设置,识别照片中的特征点。
6.一种多位置机动车定位装置,用于机动车,所述机动车安装有相机,其特征在于,所述多位置机动车定位装置包括:
推定当前位置确定单元,用于确定m个推定当前位置,所述m个推定当前位置在预定的范围内,m是大于1的正整数;
图片获取单元,在所述机动车运动过程中,利用所述相机在所述机动车实际运动轨迹上的n个轨迹位置获得图片,从而得到n张图片,所述n个轨迹位置的测量间隔在运动位置推算算法的精度范围内,所述运动位置推算算法用于在机动车运动过程中推算机动车的位置,n为大于1的整数;
特征点获取单元,用于在各所述图片中获得特征点,并取得该特征点在三维地图中的位置,即该特征点的地图位置;
匹配距离获得单元,用于针对所述m个推定当前位置中的各推定当前位置,根据各推定当前位置的运动轨迹,获得m个匹配距离;
当前位置确定单元,用于根据所述m个匹配距离确定匹配度,将匹配度最高的推定当前位置,确定为当前位置,
针对各推定当前位置,匹配距离获得单元如下地获取其匹配距离:
确定该推定当前位置的对应运动轨迹,并根据该运动轨迹确定在所述n个轨迹位置的各轨迹位置时,假定机动车处于对应于该推定当前位置的情况下,所述相机的位置,从而获得n个相机位置;
针对各所述特征点,利用所述n个相机位置,分别获取基于各特征点的特征点向量,从而得到n个特征点向量,所述特征点向量是相机到对应特征点的向量;
计算该特征点的地图位置到其对应的特征点向量的距离,从而获得n个距离;
根据该n个距离,确定该推定当前位置的匹配距离,
所述推定当前位置确定单元如下地获取所述推定当前位置:
设定起始点位置,所述起始点位置所在的位置范围是已知的;
在该起始点位置周围一定的范围内随机生成多个虚拟位置;
在机动车运动时,利用扩展卡尔曼滤波算法推定运动后的所述起始点位置和所述多个虚拟位置;
将推定出的运动后的所述起始点位置和所述多个虚拟位置的当前位置设定为所述推定当前位置。
7.根据权利要求6所述的多位置机动车定位装置,其特征在于,所述特征点获取单元在各所述图片中获得k个特征点,k是大于1的正整数,所述匹配距离获得单元400针对所述n张图片中的各图片,分别获取k个特征点向量,从而获得k*n个距离,所述匹配距离取所述k*n个距离的平均值或和值,其中,所述特征点多于三个,而且任何特征点不在其他任何两个特征点的连线或连线的延长线上。
8.一种电子设备,其特征在于,包括:
处理器;
用于存储所述处理器可执行指令的存储器;
其中,所述处理器被配置为执行所述指令,以实现如权利要求1至5中任一项所述的方法。
9.一种计算机可读存储介质,其特征在于,所述可读存储介质上存储设备控制程序,当所述设备控制程序被处理器执行时,实现如权利要求1至5中任一项所述的方法。
CN202210106791.0A 2022-01-28 2022-01-28 多位置机动车定位方法和装置、电子设备和存储介质 Active CN114119759B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210106791.0A CN114119759B (zh) 2022-01-28 2022-01-28 多位置机动车定位方法和装置、电子设备和存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210106791.0A CN114119759B (zh) 2022-01-28 2022-01-28 多位置机动车定位方法和装置、电子设备和存储介质

Publications (2)

Publication Number Publication Date
CN114119759A CN114119759A (zh) 2022-03-01
CN114119759B true CN114119759B (zh) 2022-06-14

Family

ID=80362116

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210106791.0A Active CN114119759B (zh) 2022-01-28 2022-01-28 多位置机动车定位方法和装置、电子设备和存储介质

Country Status (1)

Country Link
CN (1) CN114119759B (zh)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105674993A (zh) * 2016-01-15 2016-06-15 武汉光庭科技有限公司 基于双目相机的高精度视觉定位地图生成系统及方法
CN106610294A (zh) * 2015-10-27 2017-05-03 高德信息技术有限公司 定位方法及装置
CN110285793A (zh) * 2019-07-08 2019-09-27 中原工学院 一种基于双目立体视觉系统的车辆智能测轨迹方法
CN110310304A (zh) * 2019-06-14 2019-10-08 深圳前海达闼云端智能科技有限公司 单目视觉建图和定位方法、装置、存储介质及移动设备
CN112651991A (zh) * 2019-10-10 2021-04-13 阿里巴巴集团控股有限公司 视觉定位方法、装置及计算机系统
CN112991441A (zh) * 2019-12-12 2021-06-18 北京达佳互联信息技术有限公司 相机定位方法、装置、电子设备及存储介质
CN112991440A (zh) * 2019-12-12 2021-06-18 纳恩博(北京)科技有限公司 车辆的定位方法和装置、存储介质和电子装置
CN113822299A (zh) * 2021-10-08 2021-12-21 北京易航远智科技有限公司 地图构建方法、车辆定位方法、装置、设备和存储介质

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103325108A (zh) * 2013-05-27 2013-09-25 浙江大学 一种融合光流与特征点匹配的单目视觉里程计的设计方法
US10054445B2 (en) * 2016-05-16 2018-08-21 Northrop Grumman Systems Corporation Vision-aided aerial navigation

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106610294A (zh) * 2015-10-27 2017-05-03 高德信息技术有限公司 定位方法及装置
CN105674993A (zh) * 2016-01-15 2016-06-15 武汉光庭科技有限公司 基于双目相机的高精度视觉定位地图生成系统及方法
CN110310304A (zh) * 2019-06-14 2019-10-08 深圳前海达闼云端智能科技有限公司 单目视觉建图和定位方法、装置、存储介质及移动设备
CN110285793A (zh) * 2019-07-08 2019-09-27 中原工学院 一种基于双目立体视觉系统的车辆智能测轨迹方法
CN112651991A (zh) * 2019-10-10 2021-04-13 阿里巴巴集团控股有限公司 视觉定位方法、装置及计算机系统
CN112991441A (zh) * 2019-12-12 2021-06-18 北京达佳互联信息技术有限公司 相机定位方法、装置、电子设备及存储介质
CN112991440A (zh) * 2019-12-12 2021-06-18 纳恩博(北京)科技有限公司 车辆的定位方法和装置、存储介质和电子装置
CN113822299A (zh) * 2021-10-08 2021-12-21 北京易航远智科技有限公司 地图构建方法、车辆定位方法、装置、设备和存储介质

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Position Error Correction for an Autonomous Underwater Vehicle Inertial Navigation System (INS) Using a Particle Filter;Glenn T. Donovan 等;《IEEE JOURNAL OF OCEANIC ENGINEERING》;20120731;第37卷(第3期);第431-445页 *
基于视觉复杂环境下车辆行驶轨迹预测方法;张润生 等;《机械工程学报》;20110131;第47卷(第2期);第16-24页 *
多传感器融合的智能车定位导航系统设计;李磊 等;《工程设计学报》;20190430;第26卷(第2期);第182-189页 *

Also Published As

Publication number Publication date
CN114119759A (zh) 2022-03-01

Similar Documents

Publication Publication Date Title
CN110057352B (zh) 一种相机姿态角确定方法及装置
CN111052183B (zh) 利用事件相机的视觉惯性里程计
US8259998B2 (en) Image processing device for vehicle
US10762643B2 (en) Method for evaluating image data of a vehicle camera
CN105841687B (zh) 室内定位方法和系统
JP4702569B2 (ja) 車両用画像処理装置
CA2569209C (en) Image-augmented inertial navigation system (iains) and method
US12008785B2 (en) Detection, 3D reconstruction and tracking of multiple rigid objects moving in relation to one another
EP2175237B1 (en) System and methods for image-based navigation using line features matching
KR101444685B1 (ko) 영상기반 멀티센서 데이터를 이용한 차량의 위치자세 결정 방법 및 장치
JP7077910B2 (ja) 区画線検出装置及び区画線検出方法
KR102219843B1 (ko) 자율주행을 위한 위치 추정 장치 및 방법
JP2019169942A (ja) 車両のカメラを較正する方法およびシステム
JP6229041B2 (ja) 基準方向に対する移動要素の角度偏差を推定する方法
JP6479296B2 (ja) 位置姿勢推定装置および位置姿勢推定方法
JP6932058B2 (ja) 移動体の位置推定装置及び位置推定方法
JP2021120255A (ja) 距離推定装置及び距離推定用コンピュータプログラム
JP6410231B2 (ja) 位置合わせ装置、位置合わせ方法及び位置合わせ用コンピュータプログラム
JP5086824B2 (ja) 追尾装置及び追尾方法
Huttunen et al. A monocular camera gyroscope
CN112862818B (zh) 惯性传感器和多鱼眼相机联合的地下停车场车辆定位方法
CN114119759B (zh) 多位置机动车定位方法和装置、电子设备和存储介质
CN111207688B (zh) 在载运工具中测量目标对象距离的方法、装置和载运工具
CN114117113B (zh) 多特征点机动车定位方法和装置、电子设备和存储介质
CN114119761B (zh) 多相机机动车定位方法和装置、电子设备和存储介质

Legal Events

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