8222fbd3c93672dc23304cc10f23c6b8.png

## 3.6.1

本题思路:根据(3.40)的做法,因为没有初始状态的先验,因此将初始状态项在计算中全部略去,也就是删除矩阵中对应的行、块。

根据已知条件任意时刻

根据公式(3.12):

这里删除了初始状态项,但是保留了初始时刻的观测

,因为机器人可以在不知道自己初始位置的条件下,进行观测

同样的方法,根据式(3.13b):

也即:

因此其逆矩阵:

根据(3.32),(3.33)---相对原书中公式需要删除初始状态对应那一列数据:

因此:

对称且正定,根据(3.37)做修改,因为删除了初始状态,只需:

显然满足条件
因此,该系统存在唯一解

## 3.6.2

证明只需将数据代入上一题目的公式中即可
这里假设:

在本问题中,L矩阵的中的每一项都是标量(0维张量),因此:

将矩阵相乘:

从矩阵最左边开始迭代就可以结算处$L$(注意这个矩阵元素的结算因为涉及多个开方,存在多个解,这里仅给出一个):

## 3.6.3

等价于

其中:

可逆

因此

存在

根据(3.37):


存在唯一解

github源码和完整pdf地址:

mingtiancai/reading_and_learning​github.com
86e803b7012653a8f44acd7efbe1a34c.png
Logo

CSDN联合极客时间,共同打造面向开发者的精品内容学习社区,助力成长!

更多推荐