首页
学习
活动
专区
工具
TVP
发布
精选内容/技术社群/优惠产品,尽在小程序
立即前往

卡尔曼滤波器中的协方差矩阵(P)如何根据测量值和状态估计进行更新?

卡尔曼滤波器中的协方差矩阵P是用来估计系统状态的不确定性的。它表示了状态估计值与真实值之间的差异,即估计误差的方差。在卡尔曼滤波器中,协方差矩阵P的更新是通过以下步骤进行的:

  1. 预测步骤(时间更新):
    • 根据系统的动态模型和上一时刻的状态估计值,预测当前时刻的状态估计值。
    • 根据系统的动态模型和上一时刻的协方差矩阵P,预测当前时刻的协方差矩阵P的先验估计。
  • 测量步骤(测量更新):
    • 根据测量模型和当前时刻的状态估计值,计算当前时刻的测量预测值。
    • 根据测量模型和当前时刻的协方差矩阵P的先验估计,计算当前时刻的测量预测值的协方差矩阵。
  • 卡尔曼增益计算:
    • 根据测量预测值的协方差矩阵和测量模型的噪声协方差矩阵,计算卡尔曼增益。
    • 卡尔曼增益表示了测量值与状态估计值之间的权重关系,用于调整状态估计值的更新。
  • 更新步骤:
    • 根据测量值和测量预测值的差异,计算状态估计值的更新量。
    • 根据卡尔曼增益和测量预测值的协方差矩阵,计算协方差矩阵P的后验估计。

通过以上步骤,卡尔曼滤波器中的协方差矩阵P可以根据测量值和状态估计进行更新,从而提高状态估计的准确性和稳定性。

卡尔曼滤波器是一种常用的状态估计算法,广泛应用于各种领域,如导航系统、机器人、信号处理等。在云计算领域,卡尔曼滤波器可以用于实时数据分析和预测,提供更准确的数据估计和预测结果。

腾讯云提供了一系列与卡尔曼滤波器相关的产品和服务,例如:

  • 云计算服务:腾讯云提供强大的云计算基础设施,包括计算、存储、网络等服务,可用于支持卡尔曼滤波器的实时计算和数据处理需求。详情请参考腾讯云计算服务介绍:腾讯云计算服务
  • 人工智能服务:腾讯云提供丰富的人工智能服务,包括图像识别、语音识别、自然语言处理等,可用于卡尔曼滤波器相关应用中的数据处理和分析。详情请参考腾讯云人工智能服务介绍:腾讯云人工智能服务
  • 数据库服务:腾讯云提供高性能、可扩展的数据库服务,如云数据库MySQL、云数据库MongoDB等,可用于存储和管理卡尔曼滤波器的状态估计结果和相关数据。详情请参考腾讯云数据库服务介绍:腾讯云数据库服务

以上是关于卡尔曼滤波器中协方差矩阵P的更新方法以及腾讯云相关产品的介绍。希望对您有所帮助!

页面内容是否对你有帮助?
有帮助
没帮助

相关·内容

卡尔滤波原理详解及系统模型建立(simulink)

很简单看下面这个图: KF就是卡尔滤波,算法输入值是一个可量,这个量可以是任何量反正得你能测量出来,而且还知道这个测量值精度大概在多少,有了这个测量值我们就根据量值估计这个系统真实输出...图中绿色部分就是我现在能信任最准确小车位置,它是由我估计出来测量出来值共同估计,也就是卡尔滤波输出值,而下一步我会根据这个最优估计进行估计,(也就是我前面讲“脚”,但是这个时候脚估计值精度已经明显提高了...下面我们在k时刻对系统真实值进行测量,也就是下面公式里Z(k),这时候量值就是我们可以得到了,H是测量矩阵,比如我们要是小车位移,那给状态变量矩阵左乘一个测量矩阵就得到了我们要位移。...总结一下 卡尔滤波五个等式: 前两步是根据上一个最优估计值得出此刻估计估计协方差,紧接着就可以得到此刻最优估计最优估计协方差,然后利用此刻最优估计最优估计协方差进行下一个迭代...,温度变化一般就认为是不变化,所以状态转移矩阵也就是1,而温度也是直接可,所以测量矩阵也就是1。

3.6K32

稳态时变卡尔滤波器KALMAN FILTER设计仿真植物动力学模型案例研究

p=24947 本案例研究说明了卡尔滤波器设计仿真。考虑稳态时变卡尔滤波器。 植物动力学 考虑一个在输入u[n]上有加性高斯噪声w[n]离散植物。...测量更新: 时间更新: 在这些方程: ˆx[n|n−1] 是 x[n] 估计值,给定过去直到 yv[n−1] 量值。 ˆx[n|n] 是基于最后一次测量 yv[n] 更新估计。...这种差异由下式给出: 给定噪声协方差,选择创新增益 M 以最小化估计误差稳态协方差: 您可以将时间测量更新方程组合到一个状态空间模型,即卡尔滤波器: 该滤波器生成 yn 最佳估计 ˆy[...此外: 为简单起见,表示状态空间矩阵时间依赖性下标已被删除。 给定初始条件 x[1|0] P[1|0],您可以迭代这些方程来执行过滤。您必须在每个时间样本更新状态估计 x[n|.]...误差协方差矩阵 P[n|.]。 时变设计 要实现这些滤波器递归,首先要生成噪声输出测量值。使用 之前产生过程噪声 w 测量噪声 v。

75610

解读基于多传感器融合的卡尔滤波算法

如何协调这些传感器测量?这就是卡尔滤波器功能。卡尔滤波在自动驾驶汽车上应用十分广泛,本文讲述卡尔滤波算法,希望对你有所帮助。...那我们又如何矩阵来预测下一个时刻位置速度呢?下面用一个基本运动学公式来表示: 现在,我们有了一个预测矩阵来表示下一时刻状态,但是,我们仍然不知道怎么更新协方差矩阵。...它假定位置参数是符合高斯分布,即完全可以被均值和协方差参数化:X∼N(μ, σ²) 当传感器信息流开始时候,卡尔滤波器使用一系列状态信息来预测衡量更新步骤去更新被追踪目标的信心值(概率)。...一个系统在t时刻线性状态可以从t-1时刻根据以下等式被估计: 衡量更新卡尔滤波器下一部分则是去使用实测参数z去更新预测状态'x',通过缩放因子(通常称之为卡尔增益)成比例计算估计量值之间误差...in blue print(x) print(P) 卡尔滤波器迭代:滤波器在迭代之后向真实值收敛 上方图阐述了滤波器在每次迭代状态向量px,py维度位置协方差发生了哪些变化。

2.5K10

基于扩展卡尔滤波(EKF)机器人状态估计

EKF目的是使卡尔滤波器能够应用于机器人等非线性运动系统,EKF生成状态估计比仅使用实际测量值更准确。在本文中,我们将简要介绍扩展卡尔滤波器,并了解传感器融合工作原理。...基于上述讨论,我们做出了以下两个假设: 状态模型根据控制输入估计机器人状态 观测模型使用预测状态推断传感器测量 扩展卡尔滤波(EKF) EKF计算当前时间步长t预测传感器测量值(如上所述)这些实际传感器测量值加权平均值...EKF有两个阶段:预测更新(如下图所示) 上图显示了扩展卡尔滤波器预测更新步骤。在预测步骤,我们首先使用状态空间或运动模型来估计状态(Xt)(我们去除了噪声项,只是为了让它看起来干净)。...此外,汽车初始状态向量控制命令将为零。 矩阵F是状态转移矩阵,用于预测下一个值X和协方差矩阵P矩阵Q是过程噪声协方差矩阵。Q维数是(状态数*状态数),在我们例子,它是3x3。...换句话说,Kalman增益(K)包含关于当前预测X当前观测测量z权重信息,这将导致最终融合更新状态向量X过程协方差矩阵P。 至此,我们已经完成了EKF。

74020

卡尔(Kalman)滤波算法原理、C语言实现及实际应用

二、简介   采用递归方法解决线性滤波问题,只需要当前量值前一个采样周期估计值就能进行状态估计,需要存储空间小,每一步计算量小。 三、组成 1....卡尔增益方程 (1)目的   根据(k时刻) 协方差矩阵预测值 计算 卡尔增益。 (2)方程 (3)备注   ①. 当 Pk|k-1 为一个一维矩阵时,Hk 是1。 4....跟新最优值方程(卡尔滤波输出) (1)目的   根据 状态变量预测值 系统测量值 计算出 k时刻状态变量最优值。 (2)方程 (3)备注   ①....当 Pk|k-1 为一个一维矩阵时,Hk 是1。 5. 更新协方差方程 (1)目的   为了求 k时刻协方差矩阵。(为得到k+1时刻的卡尔输出值做准备) (2)方程 (3)备注   ①....R); //更新最优值方程:k时刻状态变量最优值 = 状态变量预测值 + 卡尔增益 * (测量值 - 状态变量预测值) kfp->out = kfp->out + kfp->

4.5K22

MSCKF理论推导与代码解析

那么什么是卡尔滤波器(KF)? 通俗来讲,卡尔滤波器根据当前状态,预测估计下一状态算法。卡尔滤波器方法在一定程度上架设了马尔可夫性,也就是k时刻状态只与k-1时刻状态有关。...卡尔滤波器主要解决线性化问题,而将卡尔滤波器结果扩展到非线性系统,便形成了扩展卡尔滤波器(EKF)。 从k-1时刻到k时刻,存在系统状态预测方程系统状态观测方程: ? ? ?...对于PV来说,更新公式如下图: ? 而Q更新是假设匀速运动,用角速度与时间相乘: ? 协方差更新,先对协方差矩阵进行划分: ?...协方差更新如下: ? 在代码开始初始化部分,对进行了初始化预设: ? 同时对连续噪声协方差Q进行了初始化预设: ? 量模型根据失去跟踪特征点建立残差方程: ?...计算出后,进入measurementUpdate(),进行更新,首先计算卡尔增益: ? 然后是更新IMU状态: ? 更新相机状态: ? 最后更新状态协方差: ?

1.6K10

MSCKF理论推导与代码解析

那么什么是卡尔滤波器(KF)? 通俗来讲,卡尔滤波器根据当前状态,预测估计下一状态算法。卡尔滤波器方法在一定程度上架设了马尔可夫性,也就是k时刻状态只与k-1时刻状态有关。...卡尔滤波器主要解决线性化问题,而将卡尔滤波器结果扩展到非线性系统,便形成了扩展卡尔滤波器(EKF)。 从k-1时刻到k时刻,存在系统状态预测方程系统状态观测方程: ? ? ?...对于PV来说,更新公式如下图: ? 而Q更新是假设匀速运动,用角速度与时间相乘: ? 协方差更新,先对协方差矩阵进行划分: ?...协方差更新如下: ? 在代码开始初始化部分,对进行了初始化预设: ? 同时对连续噪声协方差Q进行了初始化预设: ? 量模型根据失去跟踪特征点建立残差方程: ?...计算出后,进入measurementUpdate(),进行更新,首先计算卡尔增益: ? 然后是更新IMU状态: ? 更新相机状态: ? 最后更新状态协方差: ?

1.7K31

【译】图解卡尔滤波(Kalman Filter)

它提供了一种高效可计算方法来估计过程状态,并使估计均方误差最小。卡尔滤波器应用广泛且功能强大:它可以估计信号过去当前状态,甚至能估计将来状态,即使并不知道模型的确切性质。...这就是卡尔滤波器目标,我们希望从不确定测量尽可能多地获取信息! 这种状态相关性可以由协方差矩阵表示。简而言之,矩阵每个元素是第i个状态变量第j个状态变量之间相关度。...但我们仍然不知道如何更新状态协方差矩阵,其实过程也是很简单,如果我们将分布每个点乘以矩阵,那么其协方差矩阵会发生什么?...接下来我们可以继续进行预测,然后更新,重复上述过程!下图给出卡尔滤波信息流。 ? 总结 在上述所有数学公式,你需要实现只是公式(7)(18)(19)。...对于非线性系统,我们使用扩展卡尔滤波器,该滤波器通过简单地线性化预测量值均值进行工作。

3.1K32

卡尔滤波器原理matlab实现

卡尔滤波器递归过程: 估计时刻k 状态: X(k) = AX(k-1) + Bu(k) 这里, u(k) 是系统输入,在项目中,一维输入信号A=1 计算误差相关矩阵P, 度量估计精确程度...计算卡尔增益, 以下略去 (k), 即 P = P(k), X = X(k): K = P C’ (C * P * C’ + R) -1 这里 R = E{ Vj^2 }, 是测量噪声协方差(阵),...X(k) 这里 Z(k) 是带噪声测量,在项目中,一维输入信号C=1 更新误差相关矩阵P P = P – K * C * P 更新状态变量: X =X + Ke = X + K (Z(k) – C*...=2:N %在进行温度预测时,因为温度是一个连续状态,我们认为上一时刻温度当前时刻温度相等,则有T(k)=T(k-1)。...k)/(P_pre(k)+R); % 计算卡尔增益 T_kalman(k)=T_pre(k)+K(k)*(T_mearsured(k)-T_pre(k)); % 更新状态变量 P_kalman

51120

经典重温:卡尔滤波器介绍与理论分析

卡尔滤波背景 卡尔滤波常用于动态多变化系统状态估计,是一种通用性强自回归滤波器。它由来NASA登月有关。...NASA最终使用了这个滤波器,然后成功实现人类第一次登月计划。卡尔滤波器由此得名。 卡尔滤波器可以用来估计不确定信息,并给出状态量下一时刻情况。...回到上个例子,位置速度关系其实是不确定,但是却是有相关性,只是不能直观看出来。那么如何衡量这种相关性呢?其中一个办法就是使用协方差矩阵,来衡量两个变量相关程度。...给定 ,对应协方差矩阵p为 考虑到预测矩阵影响,给定上一时刻 ,对应可以更新为 由此便解决了理想情况下卡尔滤波如何做预测问题。但是实际情况下,系统可能还是存在干扰或者噪声因素。...)我们介绍了观测变量,下标为ob,分布均值记为 , 方差记为 3)基于1,2,我们代入即可推导出完整的卡尔滤波公式 所以根据刚才列出计算式分别代入,我们可以得到, 进而可以求解得状态更新方程卡尔增益求解公式

7.2K10

自动驾驶传感器融合算法:第一部分-卡尔滤波器扩展卡尔滤波器

该文章展示了在位置追踪估计中最通用算法,卡尔滤波器变种——‘扩展卡尔滤波器’。在进一步文章,我们会兼顾到其他技术比如无损卡尔滤波器粒子滤波器。 ?...1.使用激光雷达数据基础卡尔滤波器: 卡尔滤波器历史已经超过半个世纪,但是对于输入数据噪声信息状态估计平滑来说仍然是最有效传感器融合算法之一.它假定位置参数是符合高斯分布,即完全可以被均值和协方差参数化...衡量更新: 卡尔滤波器下一部分则是去使用实测参数z去更新预测状态'x',通过缩放因子(通常称之为卡尔增益)成比例计算估计量值之间误差. ?...卡尔滤波器迭代:滤波器在迭代之后向真实值收敛 下方图阐述了滤波器在每次迭代状态向量px,py维度位置协方差发生了哪些变化。红圈表示初始过程不确定性。...扩展卡尔滤波器使用局部线性模型来逼近非线性模型,然后使用卡尔滤波应用到逼近值上。局部线性逼近是通过计算当前状态估计一阶泰勒展开得出。一阶逼近也叫雅克比矩阵

2.5K50

Self-Driving干货铺2:卡尔滤波

导文 卡尔滤波是无人驾驶应用最广泛算法之一,在传感器融合与定位几乎无处不在,之前一直想写篇卡尔滤波器文章,但理解应用程度都无法企及BZARG 大神文章,因此就对该文章分享一波,本文原文来自...s_tid=srchtitle 什么是卡尔滤波? 卡尔滤波(Kalman filtering)一种利用线性系统状态方程,通过系统输入输出观测数据,对系统状态进行最优估计算法。...卡尔滤波是如何看到你问题 下面我们继续以只有位置速度这两个状态简单例子做解释。...这种相关性用协方差矩阵来表示,简而言之,矩阵每个元素 ∑ij 表示第 i 个第 j 个状态变量之间相关度。(你可能已经猜到协方差矩阵是一个对称矩阵,这意味着可以任意交换 i j)。...那我们又如何矩阵来预测下一个时刻位置速度呢?下面用一个基本运动学公式来表示: 现在,我们有了一个预测矩阵来表示下一时刻状态,但是,我们仍然不知道怎么更新协方差矩阵

58031

卡尔滤波简介

卡尔滤波是一种在不确定状况下组合多源信息得到所需状态最优估计一种方法。本文将简要介绍卡尔滤波原理及推导。...这两个问题正是卡尔滤波要解决问题,形式化两个问题如下: 预测未来 修正当下 下面,将以机器人导航为例,从预测未来修正当下两个角度介绍卡尔滤波器。...其状态xx表示为一维大小为2向量,元素分别表示位置信息与速度信息: 可是状态xx不一定是精准,其不确定性用协方差表示: 预测未来 只考虑自身状态 只考虑自身状态情况下,根据物理公式,可得: 用矩阵表示如下...: 在状态变化过程引入了新不确定性,根据协方差乘积公式可得: 考虑外部状态 外部状态,这里以加速度为例,引入变量 同时,环境仍然存在我们无法刻画误差,以 表示,最终预测公式如下: 从上述式子可见...新不确定度是预测不确定度加上环境不确定度。 修正当下 我们已得到 ,下面要通过观测到量值进行更新

1.7K50

项目实践 | 从零开始学习Deep SORT+YOLO V3进行多目标跟踪(附注释项目代码)

用本帧匹配到目标检测Box去更新卡尔跟踪器,计算卡尔增益,状态更新协方差更新。...时间更新方程(即预测阶段)根据前一时刻状态估计值推算当前时刻状态变量先验估计误差协方差先验估计值;测量更新方程(即更新阶段)负责将先验估计测量变量结合起来构造改进后验估计。...(1)、预测(Prediction):根据上一时刻(k-1时刻)后验估计值来估计当前时刻(k时刻)状态,得到k时刻先验估计值,卡尔滤波器时间更新方程: ?...(2)、 更新(Update):使用当前时刻量值来更正预测阶段估计值, 得到当前时刻后验估计值,卡尔滤波 器状态更新方程: ?...总体流程就是: 卡尔滤波器预测轨迹 Tracks; 使用匈牙利算法将预测得到轨迹 Tracks 当前帧 detections 进行匹配(级联匹配 IOU 匹配); 卡尔滤波更新

3.6K41

卡尔滤波

问题描述 卡尔滤波能够从算法角度提高传感器测试精度,弱化噪声信号影响,在航空航天、传感技术、机器人以及控制系统设计等领域具有广泛应用;调研可知,卡尔滤波与FIR滤波器相比,内存占用较小、计算速度快...:1、系统状态估计:通过传感器间接测量火箭发动机运行状态,进而计算出药柱燃烧温度等物理参量;2、多源传感器数据融合:如何从多种含有噪声信号(GPS、陀螺仪及激光雷达等)确定目标位置; 附录:补充材料...卡尔滤波本质属于系统最优估计,通过卡尔增益来修正状态预测值,减小噪声信号对测试精度影响,其核心内容是基于上一时刻状态估计值以及当前状态观测值,给出当前状态最优估计,该算法涉及核心方程有...P_为先验估计误差协方差 % P为后验估计误差协方差 % Z为测量结果,测量数据(实验结果) % K为卡尔增益 % 核心代码 % 读取传感器输出信号 node='信号采集结果.txt'; [x,...(n)=Xbar(n-1); % 更新先验估计误差协方差 P_(n)=P(n-1)+Q; % 状态更新 K(n)=P_(n)/(P_(n)+R); Xbar(n)=X_bar

75420

面向软件工程师的卡尔滤波器

KF将根据估计过程中发生事情进行更新,你唯一要做就是将其初始化为足够好值。“足够好”取决于你应用程序,你传感器,你模型等。通常,KF需要一点时间才能收敛到正确估计值。 KF如何工作?...KF家族 根据所使用模型类型(状态转换测量),可以将KF分为两个大类:如果模型是线性,则具有线性卡尔滤波器,而如果它们是非线性,则具有非线性卡尔滤波器。 为什么要区分?...机器人会及时移动(实际位置显示为黑色),在每个步骤,你都会得到非常嘈杂GPS测量值,该测量值给出xy(红色)并估算位置(蓝色)。你可以使用不同参数,看看它们如何影响状态估计。.../ 结论:我们深入研究了状态估计是什么,卡尔滤波器工作原理,其背后直觉是什么,如何使用它们以及何时使用。...我们介绍了一个玩具(但现实生活)问题,并介绍了如何使用卡尔滤波器解决该问题。然后,我们更深入地研究了Kalman滤波器在幕后实际作用。

86920

卡尔滤波应用及其matlab实现

P=F*P0*F'+Q; %求卡尔增益 K=P*H'*inv(H*P*H'+R); %状态更新 Xekf(k)=Xn+K*(y(k)-Zn); %协方差更新...如果线性化假设不成立,采用这种算法则会导致滤波器性能下降以至于造成发散。另外,在一般情况下计算系统状态方程观测方程Jacobian矩阵是不易实现,增加了算法计算复杂度。...无迹卡尔滤波UKF摒弃了对非线性函数进行线性化传统做法,采用卡尔线性滤波框架,对于一步预测方程,使用无迹变换UT来处理均值和协方差非线性传递问题。...*inv(Pzz); %第八步,状态方差更新 X=X1means+K*(Z-Zpre);%状态更新 P=P1-K*Pxz';%协方差更新 %UT变换子函数 % 输入:fun为函数句柄,Xsigma为样本集...IMM算法使用两个或更多模型来描述工作过程可能状态,最后通过有效加权融合进行系统状态估计,很好地克服了单模型估计误差较大问题。

89442

一文了解卡尔滤波原理

但是,如果使用所有对我们可用信息,我们能得到一个比任何依据自身估计更好结果吗?回答当然是YES,这就是卡尔滤波用处。 卡尔滤波是如何看到你问题?...它将我们原始估计每个点都移动到了一个新预测位置,如果原始估计是正确的话,这个新预测位置就是系统下一步会移动到位置。那我们又如何矩阵来预测下一个时刻位置速度呢?...卡尔滤波一大优点就是能处理传感器噪声,换句话说,我们传感器或多或少都有点不可靠,并且原始估计每个状态可以一定范围内传感器读数对应起来。 ?...上式给出了完整更新步骤方程。 ? 就是新最优估计,我们可以将它 ? 放到下一个预测更新方程不断迭代。 ? 总结 以上所有公式,只需要用到式(7)、(18)、(19)。...(如果忘了的话,你可以根据式(4)(15)重新推导一下) 我们可以用这些公式对任何线性系统建立精确模型,对于非线性系统来说,我们使用扩展卡尔滤波,区别在于EKF多了一个把预测测量部分进行线性化过程

1.1K30

矩阵状态转移方程

高维高斯函数 均值现在是一个向量,每个维度对应一个元素,方差变为协方差协方差定义是高斯函数分散 ? 当高斯函数倾斜时,XY不确定性是相关联。...卡尔滤波器预测 对于卡尔滤波器,我们将构建二维估计,一个针对位置 ? ,一个针对速度 ? 如果:知道位置但是速度不确定,则高斯分布表示为在正确位置周围细长分布 ?...卡尔滤波器方程式 ? ? 其中, ? 表示为一个估计值,为了让方程看起来更为简洁: 去掉 ? 帽子符号 ? 最终我们得到: ? ?...其中,小写变量表示向量,大写变量表示矩阵 变量定义 ? —状态向量 ? —状态转移矩阵 ? —误差协方差矩阵 ? —测量噪声协方差矩阵 ? —计算卡尔增益中间矩阵 ?...—Identity matrix 单位矩阵 预测步骤方程 预测状态向量与误差协方差矩阵 ? ? 更新步骤方程 卡尔增益 ? ? 更新状态向量与误差协方差矩阵 ? ? ?

1K60

使用卡尔滤波器路标实现机器人定位

均值表示最高概率值,方差表示我们认为这个均值有多大不确定性。 卡尔滤波器运行2个步骤。在预测步骤,卡尔滤波器以当前状态量值生成预测不确定度。...它可以实时运行,仅需要当前测量输入前个计算状态不确定矩阵;不需要更多过去信息。 因为Wikipedia 关于卡尔滤波器信息流图太好了,我这里就直接用它了: ?...在上节内容我没有告诉你一个隐含假设:当使用卡尔滤波器时,状态转移测量必须是线性模型。从数学观点,这意味着我们可以采用这个假设线性代数优雅来更新机器人状态机器人测量。...扩展卡尔滤波基本上是“正常”卡尔滤波,只是对现有的非线性状态转移模型测量模型进行了额外线性化。...在我们例子,Robby迷路了,想要在这个(有争议)敌对环境中进行本地化,扩展卡尔滤波使Robby能够感知地标并相应地更新状态信念。

1.1K61
领券