卡尔曼滤波的学习与应用(十一)

[复制链接]

45

主题

179

帖子

455

积分

二氧化硅

Rank: 2

积分
455
楼主
查看: 2221回复: 1 发表于 2018-11-27 15:00:15   只看该作者
4.3 雅可比矩阵
雅可比(Jacobi)矩阵在各种场合应用很多。雅可比就是输出量与输入量的微分比,表明了输入量的变化(微分)对输出量变化的影响。
对于单变量函数 y = f (x) ,雅可比 J (x) = dy dx ,即 dy = J (x)dx ,所以雅可比实际上也就是输出量对输入量的一阶导数。
对于输入量和输出量都是向量的函数关系,雅可比就变成了矩阵,称为雅可比矩阵,同样表示的是输出量与输入量之间的微分关系。


y x 的雅可比矩阵为:


在机器人系统中,操作臂的运动方程 x = f (q) 代表操作空间 x 与关节空间 q 之间的位移关系。将式子两边对时间求导,即得出 q x 的微分关系。
代表操作空间与关节空间的速度关系。J (q)称为速度雅可比矩阵。
可以看出雅可比矩阵实际上就是输出量对输入量的一阶导数,所以可以直接针对一个函数关系写出相应的雅可比矩阵。
对于直角坐标与极坐标的变换关系


可以简写成 z = f (q),其中


那么直接写出 z q 的雅可比矩阵:


z q 之间是非线性关系,如果该方程应用于卡尔曼滤波,需要对方程进行线性化,利用泰勒一阶展开进行线性化。假设对值


线性化。


1

主题

13

帖子

17

积分

一粒轻沙

Rank: 1

积分
17
沙发
发表于 2019-7-28 17:16:26   只看该作者
感谢楼主分享!
快速回复 返回顶部 返回列表