CN106482736A - 一种基于平方根容积卡尔曼滤波的多机器人协同定位算法 - Google Patents
一种基于平方根容积卡尔曼滤波的多机器人协同定位算法 Download PDFInfo
- Publication number
- CN106482736A CN106482736A CN201610538987.1A CN201610538987A CN106482736A CN 106482736 A CN106482736 A CN 106482736A CN 201610538987 A CN201610538987 A CN 201610538987A CN 106482736 A CN106482736 A CN 106482736A
- Authority
- CN
- China
- Prior art keywords
- robot
- volume
- colocated
- multirobot
- matrix
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本实发明公开了一种基于平方根容积卡尔曼滤波(Square Root Cubature Kalman Filtering,SR‑CKF)的多机器人协同定位算法,属于机器人协同定位领域。整个算法分为两步:预测和更新。首先建立机器人运动方程和观测方程,利用相对方位作为测量值,进一步得到多机器人协同定位的动态模型。预测阶段包括:计算容积点集;通过状态方程传播容积点;机器人位姿状态预估计和平方根因子预测。更新阶段包括:计算容积点集;计算卡尔曼增益;计算位姿信息和平方根因子;更新状态向量、协方差阵和位姿信息。本发明实例在更新过程中直接传递目标状态均值和协方差矩阵的平方根因子,降低了计算的复杂度,确保了协方差矩阵的对称性和半正定性,改进了数值精度和稳定性。
Description
技术领域
本发明涉及机器人协同定位领域,一种基于平方根容积卡尔曼滤波的多机器人协同定位算法。
背景技术
随着人们的研究领域不断拓宽,从陆地、海洋延伸到深海以至未知的外太空,多机器人协同***在军事、航天、服务、工业等领域发挥着越来越重要的作用。能够对未知复杂外界环境信息感知、建模并确定自身的位置,是机器人自主导航的前提和基础。多机器人协同定位是指多机器人之间相互观测,不依赖于外部环境通过共享环境信息,实现在共同环境下确定各自的位姿信息。
目前,已有多种解决多机器人协同定位的方法,Jennings和Murray利用基于视觉的方法首次实现了机器人的协同定位。第一个机器人采用一种新的路标识别方法能够自主发现路标,第二个机器人将自己获取的图像帧与第一个机器人的图像帧进行比较,实现自身的相对定位。由于该方法依赖于准确的地图匹配,所以鲁棒性不强。Fox等人提出蒙特卡罗定位方法,首次将概率统计方法应用于多机器人协同定位。机器人所处的位置采用概率方式来描述,再交换共享其他机器人的相对观测信息,得到新的概率分布。但是在机器人识别等问题上该算法没有给出解决方案。Jo和lee等通过GPS数据差把不同机器人间的距离关联起来,进行机器人队列的相对定位。但是在GPS误差较大的情况下,该方法的实时性与精确性较差。王玲和邵金鑫等利用扩展卡尔曼滤波,将机器人内部传感器信息与队列中其他机器人之间的相对观测量相融合,以确定***中的每个机器人的位置。该算法具有较好的实时性,但是该算法容易产生误差积累,并且其计算量会随地图的增大而急剧增大。
发明内容
本发明的目的在于提供一种基于SR-CKF的相对方位多机器人协同定位算法,以解决现有技术中导致的上述多项缺陷。
本发明实施例采用如下技术方案:
一种基于SR-CKF的相对方位多机器人协同定位算法,整个算法分为两步:预测和更新。首先建立机器人运动方程和观测方程,利用相对方位作为测量值,进一步得到多机器人协同定位的动态模型。预测阶段包括:计算容积点集;通过状态方程传播容积点;机器人位姿状态预估计和平方根因子预测。更新阶段包括:计算容积点集;计算卡尔曼增益;计算位姿信息和平方根因子;更新状态向量、协方差阵和位姿信息。
优选的,所述计算容积点集之前还包括:建立机器人运动方程。
在队列的行进过程中,向量为***时刻的状态向量,为维的向量;向量表示地图特征路标集合矩阵,机器人的运动方程均相同,故以机器人为例其运动模型可以表示为:
其中表示控制输入,为维的向量;为运动噪声,其方差为,服从于的高斯分布。
优选的,所述计算容积点集之前还包括:建立机器人观测方程。
在机器人运动的过程中,表示时刻***的观测向量矩阵,为维的向量,机器人在未知环境中存在两种观测值,地图环境特征点的观测值和对其他机器人的相对方位信息,机器人在时刻观测到机器人,由外部传感器得到它们之间的相对方位信息。,分别为它们各自的运动方向,为时刻机器人观测到机器人的相对方位角则:
可以得到一般形式的观测模型:
其中表示观测噪声矩阵,其方差为,服从于的高斯分布。
优选的,所述计算容积点集包括:
时刻的地图特征点信息、运动控制信息和机器人的位姿信息都包含于矩阵中,以到时刻为例,将误差协方差阵通过Cholesky分解可得,利用机器人控制输入对状态信息矩阵状态增广,可以得到:
优选的,所述通过状态方程传播容积点:
优选的,所述机器人位姿状态预估计和平方根因子预测包括:
时刻机器人的状态估计:由容积变换,可得:
使用容积变换进行,将特征误差向量进行分解,即可获得平方根因子矩阵:
优选的,所述更新阶段计算容积点集包括:
时刻机器人观测到特征点与其他机器人的相对方位信息,此时要根据观测值计算观测向量的后验概率分布。
优选的,所述计算卡尔曼增益包括:
其中,机器人结合自身新的容积点和机器人新的容积点利用观测方程对其进行更新,可以得到每个容积点的观测值。再根据容积变换,可以得到:
其中,为观测误差向量,矩阵为观测信息自相关协方差矩阵,矩阵为观测误差向量和地图特征误差向量的互相关协方差矩阵。
可得,卡尔曼滤波增益矩阵:
优选的,所述计算位姿信息和平方根因子包括:
根据卡尔曼增益可计算得到机器人的位姿信息矩阵:
其中是机器人在时刻通过外部传感器观测到队列中其他个机器人相对方位角的实际观测值。
平方根因子矩阵可以由下式得到:
优选的,所述更新状态向量、协方差阵和位姿信息包括:
当同一时刻多个特征点同时被观测到时,需要对以下两个式子进行计算,然后再重复预测和更新的步骤:
本发明的优点在于:1、本发明算法将机器人通过传感器得到的自身位姿信息与其他机器人的相对方位信息融合起来,整个机器人队列内部共享这些观测信息提高了***的鲁棒性和效率。2、在更新过程中直接传递目标状态均值和协方差矩阵的平方根因子,使得***更稳定,有效的提高了定位的精度。3、在计算均值和方差时采用基于容积准则的数值积分方法,减少了截断误差,降低了计算复杂度,缩短了算法耗时,实时性强。
附图说明
图1为本发明一种基于平方根容积卡尔曼滤波的多机器人协同定位算法流程图;
图2为本发明一种基于平方根容积卡尔曼滤波的多机器人协同定位算法Ra、Rb之间的相对观测量示意图;
图3为本发明一种基于平方根容积卡尔曼滤波的多机器人协同定位算法协同定位方案示意图。
具体实施方式
为使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体实施方式,进一步阐述本发明。
根据本发明一个实施例,如图1所示,整个算法分为两步:预测和更新。首先建立机器人运动方程和观测方程,利用相对方位作为测量值,进一步得到多机器人协同定位的动态模型。预测阶段包括:计算容积点集;通过状态方程传播容积点;机器人位姿状态预估计和平方根因子预测。更新阶段包括:计算容积点集;计算卡尔曼增益;计算位姿信息和平方根因子;更新状态向量、协方差阵和位姿信息。
另外,如图2所示,当N个机器人组成队列在某一环境中沿不同方向运动,为了确保多机器人协同定位条件以及描述机器人之间的相对观测信息,对队列中机器人所需要的条件进行如下假设:
(1)每个机器人都配有可感知自身位姿信息的内部传感器和感知外部环境的外部传感器,通过携带的外部传感器可有效的探测到附近机器人对其的观测信息;
(2)通过通信协议每个机器人感知的外部环境可与其他机器人感知的数据之间进行交流融合;
(3)队列中每个机器人的外部传感器是相同的,因而可以用同一数学模型描述它们之间的观测信息。
多个机器人组成队列在二维环境下移动,为机器人在时刻的位姿,其中、和分别表示机器人在时刻的横坐标,纵坐标和运动方向,则时机器人队列的位姿信息可以表示为:
在队列的行进过程中,向量为***时刻的状态向量,为维的向量;向量表示地图特征路标集合矩阵,机器人的运动方程均相同,故以机器人为例其运动模型可以表示为:
其中表示控制输入,为维的向量;为运动噪声,其方差为,服从于的高斯分布。
在机器人运动的过程中,表示时刻***的观测向量矩阵,为维的向量,机器人在时刻观测到机器人,由外部传感器得到它们之间的相对方位信息。如图1所示,,分别为它们各自的运动方向,为时刻机器人观测到机器人的相对方位角则:
可以得到一般形式的观测模型:
其中表示观测噪声矩阵,其方差为,服从于的高斯分布。
如图3所示,当机器人通过可感知自身位姿信息的内部传感器和感知外部环境的外部传感器,获得运动数据时,通过运动模型结合传感器所获得的相对观测信息,完成对整个队列中机器人的位姿和平方根因子的更新。在时刻,由于每个机器人状态信息更新的流程是相同的,故以机器人为例详细说明提出的多机器人协同定位算法。
所述计算容积点集之前还包括:建立机器人运动方程。
在队列的行进过程中,向量为***时刻的状态向量,为维的向量;向量表示地图特征路标集合矩阵,机器人的运动方程均相同,故以机器人为例其运动模型可以表示为
其中表示控制输入,为维的向量;为运动噪声,其方差为,服从于的高斯分布。
所述计算容积点集之前还包括:建立机器人观测方程。
在机器人运动的过程中,表示时刻***的观测向量矩阵,为维的向量,机器人在时刻观测到机器人,由外部传感器得到它们之间的相对方位信息。,分别为它们各自的运动方向,为时刻机器人观测到机器人的相对方位角。则:
可以得到一般形式的观测模型:
其中表示观测噪声矩阵,其方差为,服从于的高斯分布。
所述计算容积点集包括:
时刻的地图特征点信息、运动控制信息和机器人的位姿信息都包含于矩阵中,以到时刻为例,将误差协方差阵通过Cholesky分解可得,利用机器人控制输入对状态信息矩阵状态增广,可以得到:
所述通过状态方程传播容积点:
所述机器人位姿状态预估计和平方根因子预测包括:
时刻机器人的状态估计:由容积变换,可得:
使用容积变换进行,将特征误差向量进行分解,即可获得平方根因子矩阵:
所述更新阶段计算容积点集包括:
时刻机器人观测到特征点与其他机器人的相对方位信息,此时要根据观测值计算观测向量的后验概率分布。
所述计算卡尔曼增益包括:
其中,机器人结合自身新的容积点和机器人新的容积点利用观测方程对其进行更新,可以得到每个容积点的观测值。再根据容积变换,可以得到:
其中,为观测误差向量,矩阵为观测信息自相关协方差矩阵,矩阵为观测误差向量和地图特征误差向量的互相关协方差矩阵。
可得,卡尔曼滤波增益矩阵:
所述计算位姿信息和平方根因子包括:
根据卡尔曼增益可计算得到机器人的位姿信息矩阵:
其中是机器人在时刻通过外部传感器观测到队列中其他个机器人相对方位角的实际观测值。
平方根因子矩阵可以由下式得到:
所述更新状态向量、协方差阵和位姿信息包括:
当同一时刻多个特征点同时被观测到时,需要对以下两个式子进行计算,然后再重复预测和更新的步骤:
由技术常识可知,本实用发明可以通过其它的不脱离其精神实质或必要特征的实施方案来实现。因此,上述公开的实施方案,就各方面而言,都只是举例说明,并不是仅有的。所有在本发明范围内或在等同于本实用发明的范围内的改变均被本发明包含。
Claims (11)
1.一种基于平方根容积卡尔曼滤波(Square Root Cubature Kalman Filtering,SR-CKF)的多机器人协同定位算法,其特征在于,包括:
预测阶段包括:计算容积点集;通过状态方程传播容积点;机器人位姿状态预估计和平方根因子预测;
更新阶段包括:计算容积点集;计算卡尔曼增益;计算位姿信息和平方根因子;更新状态向量、协方差阵和位姿信息。
2.根据权利要求1所述的一种基于平方根容积卡尔曼滤波的多机器人协同定位算法,其特征在于,每个机器人都配有可感知自身位姿信息的内部传感器和感知外部环境信息的外部传感器,通过携带的外部传感器可有效的探测到附近机器人对其的观测信息,通过通信协议每个机器人感知的外部环境信息可与其他机器人感知的数据之间进行交流融合;
多个机器人组成队列在二维环境下移动,为机器人在时刻的位姿,其中、和分别表示机器人在时刻的横坐标,纵坐标和运动方向,则时机器人队列的位姿信息可以表示为:
。
3.根据权利要求1或2所述的一种基于平方根容积卡尔曼滤波的多机器人协同定位算法,其特征在于,计算容积点集之前还包括:建立机器人运动方程;
在队列的行进过程中,向量为***时刻的状态向量,为维的向量;向量表示地图特征路标集合矩阵;机器人的运动方程均相同,故以机器人为例其运动模型可以表示为:
其中表示控制输入,为维的向量;为运动噪声,其方差为,服从于的高斯分布。
4.根据权利要求1或2所述一种基于平方根容积卡尔曼滤波的多机器人协同定位算法,其特征在于,计算容积点集之前还包括:建立机器人观测方程;
在机器人运动的过程中,表示时刻***的观测向量矩阵,为维的向量,机器人在时刻观测到机器人,由外部传感器得到它们之间的相对方位信息,,分别为它们各自的运动方向,为时刻机器人观测到机器人的相对方位角,则:
可以得到一般形式的观测模型:
其中表示观测噪声矩阵,其方差为,服从于的高斯分布。
5.根据权利要求3所述的一种基于平方根容积卡尔曼滤波的多机器人协同定位算法,其特征在于,所述计算容积点集包括:
时刻的地图特征点信息、运动控制信息和机器人的位姿信息都包含于矩阵中,以到时刻为例,将误差协方差阵通过Cholesky分解可得,利用机器人控制输入对状态信息矩阵状态增广。
6.根据权利要求5所述的一种基于平方根容积卡尔曼滤波的多机器人协同定位算法,其特征在于,所述通过状态方程传播容积点。
7.根据权利要求6所述一种基于平方根容积卡尔曼滤波的多机器人协同定位算法,其特征在于,所述机器人位姿状态预估计和平方根因子预测包括:
时刻机器人的状态估计:由容积变换,可得:
使用容积变换进行,将特征误差向量进行分解,即可获得平方根因子矩阵。
8.根据权利要求4所述一种基于平方根容积卡尔曼滤波的多机器人协同定位算法,其特征在于,所述计算容积点集包括:
时刻机器人观测到特征点与其他机器人的相对方位信息,此时要根据观测值计算观测向量的后验概率分布。
9.根据权利要求8所述一种基于平方根容积卡尔曼滤波的多机器人协同定位算法,其特征在于,所述计算卡尔曼增益包括:
其中,机器人结合自身新的容积点和机器人新的容积点利用观测方程对其进行更新,可以得到每个容积点的观测值,再根据容积变换,可以得到:
其中,为观测误差向量,矩阵为观测信息自相关协方差矩阵,矩阵为观测误差向量和地图特征误差向量的互相关协方差矩阵,可得卡尔曼滤波增益矩阵。
10.根据权利要求9所述一种基于平方根容积卡尔曼滤波的多机器人协同定位算法,其特征在于,所述计算位姿信息和平方根因子包括:
根据卡尔曼增益可计算得到机器人的位姿信息矩阵:
其中是机器人在时刻通过外部传感器观测到队列中其他个机器人相对方位角的实际观测值;
平方根因子矩阵可以由下式得到。
11.根据权利要求10所述一种基于平方根容积卡尔曼滤波的多机器人协同定位算法,其特征在于,所述更新状态向量、协方差阵和位姿信息包括:
当同一时刻多个特征点同时被观测到时,需要对以下两个式子进行计算,然后再重复预测和更新的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610538987.1A CN106482736B (zh) | 2016-07-11 | 2016-07-11 | 一种基于平方根容积卡尔曼滤波的多机器人协同定位算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610538987.1A CN106482736B (zh) | 2016-07-11 | 2016-07-11 | 一种基于平方根容积卡尔曼滤波的多机器人协同定位算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106482736A true CN106482736A (zh) | 2017-03-08 |
CN106482736B CN106482736B (zh) | 2019-04-09 |
Family
ID=58238808
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610538987.1A Active CN106482736B (zh) | 2016-07-11 | 2016-07-11 | 一种基于平方根容积卡尔曼滤波的多机器人协同定位算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106482736B (zh) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107843259A (zh) * | 2017-10-27 | 2018-03-27 | 哈尔滨工程大学 | 一种基于vckf的多机器人协同导航定位方法 |
CN107860388A (zh) * | 2017-10-27 | 2018-03-30 | 哈尔滨工程大学 | 一种基于混合拓扑结构的多机器人协同导航定位算法 |
CN108235251A (zh) * | 2017-12-06 | 2018-06-29 | 安徽工程大学 | 基于无人机协助下的无线传感器网络节点定位方法和装置 |
CN108594169A (zh) * | 2018-03-15 | 2018-09-28 | 中国人民解放军63892部队 | 一种适应于时变通信拓扑的多机器人分布式协作定位方法 |
CN109100730A (zh) * | 2018-05-18 | 2018-12-28 | 北京师范大学-香港浸会大学***际学院 | 一种多车协同快速建图方法 |
CN109253727A (zh) * | 2018-06-22 | 2019-01-22 | 东南大学 | 一种基于改进迭代容积粒子滤波算法的定位方法 |
CN109579824A (zh) * | 2018-10-31 | 2019-04-05 | 重庆邮电大学 | 一种融入二维码信息的自适应蒙特卡诺定位方法 |
CN109633479A (zh) * | 2019-01-11 | 2019-04-16 | 武汉理工大学 | 基于嵌入式容积卡尔曼滤波的锂电池soc在线估算方法 |
CN109901100A (zh) * | 2019-03-15 | 2019-06-18 | 南京烽火星空通信发展有限公司 | 一种信标节点定位方法及物联应用 |
CN110297127A (zh) * | 2019-05-28 | 2019-10-01 | 许昌许继软件技术有限公司 | 一种交流信号滤波方法及装置 |
CN110967017A (zh) * | 2019-11-22 | 2020-04-07 | 河南科技大学 | 一种用于双移动机器人刚体协作搬运的协同定位方法 |
CN111998854A (zh) * | 2020-08-31 | 2020-11-27 | 郑州轻工业大学 | 基于Cholesky分解计算的精确扩展Stirling插值滤波方法 |
WO2021000278A1 (zh) * | 2019-07-03 | 2021-01-07 | 深圳市速腾聚创科技有限公司 | 一种多传感器状态估计方法、装置及终端设备 |
WO2021018113A1 (zh) * | 2019-07-31 | 2021-02-04 | 南京航空航天大学 | 用于无人机蜂群协同导航的动态互观测在线建模方法 |
CN112567203A (zh) * | 2018-07-23 | 2021-03-26 | 赛峰集团 | 用于使用不变卡尔曼滤波器辅助一队交通工具导航的方法和装置 |
CN112989625A (zh) * | 2021-04-02 | 2021-06-18 | 上海有个机器人有限公司 | Uwb传感器异常值的剔除方法 |
CN115979240A (zh) * | 2022-12-05 | 2023-04-18 | 哈尔滨理工大学 | 基于限制增广的新息叠加同步定位建图方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102980579A (zh) * | 2012-11-15 | 2013-03-20 | 哈尔滨工程大学 | 一种自主水下航行器自主导航定位方法 |
CN104833949A (zh) * | 2015-05-11 | 2015-08-12 | 西北工业大学 | 一种基于改进距离参数化的多无人机协同无源定位方法 |
CN105509739A (zh) * | 2016-02-04 | 2016-04-20 | 济南大学 | 采用固定区间crts平滑的ins/uwb紧组合导航***及方法 |
-
2016
- 2016-07-11 CN CN201610538987.1A patent/CN106482736B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102980579A (zh) * | 2012-11-15 | 2013-03-20 | 哈尔滨工程大学 | 一种自主水下航行器自主导航定位方法 |
CN104833949A (zh) * | 2015-05-11 | 2015-08-12 | 西北工业大学 | 一种基于改进距离参数化的多无人机协同无源定位方法 |
CN105509739A (zh) * | 2016-02-04 | 2016-04-20 | 济南大学 | 采用固定区间crts平滑的ins/uwb紧组合导航***及方法 |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107860388B (zh) * | 2017-10-27 | 2020-10-27 | 哈尔滨工程大学 | 一种基于混合拓扑结构的多机器人协同导航定位算法 |
CN107860388A (zh) * | 2017-10-27 | 2018-03-30 | 哈尔滨工程大学 | 一种基于混合拓扑结构的多机器人协同导航定位算法 |
CN107843259A (zh) * | 2017-10-27 | 2018-03-27 | 哈尔滨工程大学 | 一种基于vckf的多机器人协同导航定位方法 |
CN108235251A (zh) * | 2017-12-06 | 2018-06-29 | 安徽工程大学 | 基于无人机协助下的无线传感器网络节点定位方法和装置 |
CN108594169A (zh) * | 2018-03-15 | 2018-09-28 | 中国人民解放军63892部队 | 一种适应于时变通信拓扑的多机器人分布式协作定位方法 |
CN109100730A (zh) * | 2018-05-18 | 2018-12-28 | 北京师范大学-香港浸会大学***际学院 | 一种多车协同快速建图方法 |
CN109100730B (zh) * | 2018-05-18 | 2022-05-24 | 北京师范大学-香港浸会大学***际学院 | 一种多车协同快速建图方法 |
CN109253727A (zh) * | 2018-06-22 | 2019-01-22 | 东南大学 | 一种基于改进迭代容积粒子滤波算法的定位方法 |
CN112567203B (zh) * | 2018-07-23 | 2024-04-26 | 赛峰集团 | 用于使用不变卡尔曼滤波器辅助一队交通工具导航的方法和装置 |
CN112567203A (zh) * | 2018-07-23 | 2021-03-26 | 赛峰集团 | 用于使用不变卡尔曼滤波器辅助一队交通工具导航的方法和装置 |
CN109579824A (zh) * | 2018-10-31 | 2019-04-05 | 重庆邮电大学 | 一种融入二维码信息的自适应蒙特卡诺定位方法 |
CN109579824B (zh) * | 2018-10-31 | 2022-12-27 | 重庆邮电大学 | 一种融入二维码信息的自适应蒙特卡诺定位方法 |
CN109633479A (zh) * | 2019-01-11 | 2019-04-16 | 武汉理工大学 | 基于嵌入式容积卡尔曼滤波的锂电池soc在线估算方法 |
CN109901100A (zh) * | 2019-03-15 | 2019-06-18 | 南京烽火星空通信发展有限公司 | 一种信标节点定位方法及物联应用 |
CN110297127B (zh) * | 2019-05-28 | 2022-01-04 | 许昌许继软件技术有限公司 | 一种交流信号滤波方法及装置 |
CN110297127A (zh) * | 2019-05-28 | 2019-10-01 | 许昌许继软件技术有限公司 | 一种交流信号滤波方法及装置 |
WO2021000278A1 (zh) * | 2019-07-03 | 2021-01-07 | 深圳市速腾聚创科技有限公司 | 一种多传感器状态估计方法、装置及终端设备 |
WO2021018113A1 (zh) * | 2019-07-31 | 2021-02-04 | 南京航空航天大学 | 用于无人机蜂群协同导航的动态互观测在线建模方法 |
CN110967017A (zh) * | 2019-11-22 | 2020-04-07 | 河南科技大学 | 一种用于双移动机器人刚体协作搬运的协同定位方法 |
CN110967017B (zh) * | 2019-11-22 | 2023-03-31 | 河南科技大学 | 一种用于双移动机器人刚体协作搬运的协同定位方法 |
CN111998854A (zh) * | 2020-08-31 | 2020-11-27 | 郑州轻工业大学 | 基于Cholesky分解计算的精确扩展Stirling插值滤波方法 |
CN112989625A (zh) * | 2021-04-02 | 2021-06-18 | 上海有个机器人有限公司 | Uwb传感器异常值的剔除方法 |
CN112989625B (zh) * | 2021-04-02 | 2024-04-05 | 上海有个机器人有限公司 | Uwb传感器异常值的剔除方法 |
CN115979240A (zh) * | 2022-12-05 | 2023-04-18 | 哈尔滨理工大学 | 基于限制增广的新息叠加同步定位建图方法 |
CN115979240B (zh) * | 2022-12-05 | 2023-09-29 | 哈尔滨理工大学 | 基于限制增广的新息叠加同步定位建图方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106482736B (zh) | 2019-04-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106482736A (zh) | 一种基于平方根容积卡尔曼滤波的多机器人协同定位算法 | |
CN106323291A (zh) | 一种基于平方根容积卡尔曼滤波的多机器人协同定位算法 | |
Zhang et al. | Intelligent collaborative localization among air-ground robots for industrial environment perception | |
CN107356252B (zh) | 一种融合视觉里程计与物理里程计的室内机器人定位方法 | |
CN109100730B (zh) | 一种多车协同快速建图方法 | |
US10798526B2 (en) | Systems and methods for co-localization of multiple devices | |
RU2662913C2 (ru) | Способ локализации робота в плоскости локализации | |
CN109099912A (zh) | 室外精确定位导航方法、装置、电子设备及存储介质 | |
CN107590827A (zh) | 一种基于Kinect的室内移动机器人视觉SLAM方法 | |
CN108490433B (zh) | 基于序贯滤波的空时偏差联合估计与补偿方法及*** | |
CN110617814A (zh) | 单目视觉和惯性传感器融合的远距离测距***及方法 | |
Treuillet et al. | Outdoor/indoor vision-based localization for blind pedestrian navigation assistance | |
CN102682448B (zh) | 一种基于双三视张量的立体视觉快速导航定位方法 | |
CN110118556A (zh) | 一种基于协方差交叉融合slam的机器人定位方法及装置 | |
CN102607535B (zh) | 一种利用视差空间集束调整的高精度实时立体视觉定位方法 | |
Yuan et al. | Cooperative localization for disconnected sensor networks and a mobile robot in friendly environments | |
Herath et al. | Fusion-dhl: Wifi, imu, and floorplan fusion for dense history of locations in indoor environments | |
CN110749308A (zh) | 使用消费级gps和2.5d建筑物模型的面向slam的室外定位方法 | |
Kostavelis et al. | Visual odometry for autonomous robot navigation through efficient outlier rejection | |
CN115560760A (zh) | 一种面向无人机的视觉/激光测距高空导航方法 | |
Li et al. | Cooperative visual-range-inertial navigation for multiple unmanned aerial vehicles | |
Giubilato et al. | A comparison of monocular and stereo visual FastSLAM implementations | |
Liu et al. | A low-cost and scalable framework to build large-scale localization benchmark for augmented reality | |
Zhao et al. | 3D indoor map building with monte carlo localization in 2D map | |
Moemeni et al. | Inertial-visual pose tracking using optical flow-aided particle filtering |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |