slam学习笔记7---状态量求导相关数学公式

news/2024/12/25 10:13:27 标签: 笔记

前言:本来打算只是归纳一下数学求导相关公式,后面也写了旋转求导相关内容,哈哈。感觉有点发散把握不住呀。水平有限,欢迎评论区点出。

一、基本初等函数求导公式

  1. ( C ) ′ = 0 , C (C)'=0,C (C)=0,C为常数
  2. ( x μ ) ′ = μ x μ − 1 , μ (x^\mu)'=\mu x^{\mu-1},\mu (xμ)=μxμ1μ为常数
  3. ( s i n x ) ′ = c o s x (sinx)'=cosx (sinx)=cosx
  4. ( c o s x ) ′ = − s i n x (cosx)'=-sinx (cosx)=sinx
  5. ( t a n x ) ′ = s e c 2 x (tanx)'=sec^2x (tanx)=sec2x
  6. ( c s c x ) ′ = − c s c 2 x (cscx)'=-csc^2x (cscx)=csc2x
  7. ( s e c x ) ′ = s e c x t a n x (secx)'=secxtanx (secx)=secxtanx
  8. ( c s c x ) ′ = − c s c x c o t x (cscx)'=-cscxcotx (cscx)=cscxcotx
  9. ( a x ) ′ = a x l n a (a^x)'=a^xlna (ax)=axlna
  10. ( e x ) ′ = e x (e^x)'=e^x (ex)=ex
  11. ( l o g a x ) ′ = 1 x l n a (log{_a}x)'=\frac1{xlna} (logax)=xlna1
  12. ( l n x ) ′ = 1 x (lnx)'=\frac1{x} (lnx)=x1
  13. ( a r c s i n x ) ′ = 1 1 − x 2 (arcsinx)'=\frac 1{\sqrt{1-x^2}} (arcsinx)=1x2 1
  14. ( a r c c o s x ) ′ = − 1 1 − x 2 (arccosx)'=- \frac 1{1-x^2} (arccosx)=1x21
  15. ( a r c t a n x ) ′ = 1 1 + x 2 (arctanx)'=\frac 1{1+x^2} (arctanx)=1+x21
  16. ( a r c c o t x ) ′ = − 1 1 + x 2 (arccotx)'=- \frac 1{1+x^2} (arccotx)=1+x21

二、函数四则运算求导法则

μ = μ ( x ) , v = v ( x ) \mu=\mu(x),v=v(x) μ=μ(x),v=v(x)都可导,则

  1. ( u ± v ) ′ = u ′ ± v ′ (u\pm v)'=u' \pm v' (u±v)=u±v
  2. ( C μ ) ′ = C u ′ , C (C\mu)'=Cu',C (Cμ)=Cu,C为常数
  3. ( u v ) ′ = u ′ v + u v ′ (uv)'=u'v+uv' (uv)=uv+uv
  4. ( u v ) ′ = u ′ v − u v ′ v 2 (\frac u{v})'=\frac {u'v-uv'}{v^2} (vu)=v2uvuv

三、反函数求导数法则

若函数 x = φ ( y ) x=\varphi(y) x=φ(y)在某区间 I y I{_y} Iy内可导、单调且 φ ′ ( y ) ≠ 0 , \varphi'(y)\neq0, φ(y)=0,则它反函数 y = f ( x ) y=f(x) y=f(x)在对应区间 I x I{_x} Ix内也可导,且:
f ′ ( x ) = 1 φ ′ ( y ) f'(x)=\frac 1{\varphi'(y)} f(x)=φ(y)1

d y d x = 1 d x d y \frac {dy}{dx}=\frac {1}{\frac {dx}{dy}} dxdy=dydx1

四、旋转求导

4.1 李群李代数

简易理解,李群就是旋转矩阵表示姿态;李代数使用旋转向量表示姿态;

借助MIT牛人的一席话,理解李群李代数非凡意义:
当分析和群论走在一 起,我们就有了李群(Lie Group)和李代数(Lie Algebra)。它们给连续群上的元素赋予了代数结构。这是一门非常漂亮的数学:在一个体系中,拓扑,微分和代数走到了一起。在一定条件下, 通过李群和李代数的联系,它让几何变换的结合变成了线性运算,让子群化为线性子空间,这样就为learning中许多重要的模型和算法的引入到对几何运动 的建模创造了必要的条件。

1)两者桥梁:罗徳里格旋转公式
R = c o s θ ⋅ I + ( 1 − c o s θ ) ⋅ n ⃗ ⋅ n ⃗ T + s i n θ ⋅ n ⃗ ∧ R=cos\theta\cdot I+(1-cos\theta)\cdot \vec{n}\cdot \vec{n}^{T}+sin\theta\cdot \vec{n}^{\wedge} R=cosθI+(1cosθ)n n T+sinθn
其中, ∧ \wedge 表示向量到反对称的转换符; θ \theta θ表示转角; n ⃗ \vec{n} n 表示单位旋转向量;

2)把旋转角度约束在 ± π \pm\pi ±π范围,李群和李代数是一一对应的;否则,存在多个李代数对应同一个李群;换言之,多个旋转向量对应同一个旋转矩阵。

3)李群求导数,理解为泊松公式;

4)若知道了旋转矩阵即李群,那么通过如下方式可获取李代数:
θ = a r c c o s t r ( R ) − 1 2 \theta=arccos\frac{tr(R)-1}{2} θ=arccos2tr(R)1
R ⋅ a ⃗ = a ⃗ R\cdot \vec a=\vec a Ra =a
根据线性代数求解特征值、特征向量方式,求解特征值为1对应的向量为旋转向量。至此,完成李群到李代数的映射。

4.2 旋转矩阵

1)对时间求导数,来自泊松公式
假设旋转矩阵 R R R,角速度为 ω \omega ω,则 R R R对时间求导数表示为:
R ˙ = R ⋅ ω ∧ \dot{R}=R\cdot\omega^{\wedge} R˙=Rω
其中,
ω ∧ = [ 0 − ω 3 ω 2 ω 3 0 − ω 1 − ω 2 ω 1 0 ] \omega^{\wedge}=\begin{bmatrix} 0&-\omega{_3}&\omega{_2} \\ \omega{_3}&0&-\omega{_1}\\-\omega{_2}&\omega{_1}&0\end{bmatrix} ω= 0ω3ω2ω30ω1ω2ω10

2)对于三维空间中,点 p = [ x , y , z ] p = [x,y,z] p=[x,y,z]经过旋转矩阵 R R R变换,则变换到点 p ′ p' p,公式表示如:
p ′ = R p p'=Rp p=Rp

4.3 四元数

1)当实部接近0,其余分量会非常大,导致解不稳定;由于 q q q − q -q q表示同一个旋转,所以 R R R对应的四元数不唯一

2)在三维空间中,点 p = [ x , y , z ] p = [x,y,z] p=[x,y,z]使用四元数变换至点 p ′ p' p过程如:

将三维空间点映射到四元数空间,设 p = [ 0 , x , y , z ] p=[0,x,y,z] p=[0,x,y,z],
四元数旋转表示为 q = [ c o n θ 2 , n ⃗ ⋅ s i n θ 2 ] q=[con\frac{\theta}{2},\vec{n}\cdot sin\frac{\theta}{2}] q=[con2θ,n sin2θ], θ \theta θ表示转角, n ⃗ \vec{n} n 表示单位向量
那么,有
p ′ = q ⋅ p ⋅ q − 1 p'=q\cdot p\cdot q^{-1} p=qpq1
3)四元数与轴角的关系
假设某个旋转运动的旋转轴为单位向量 u ⃗ \vec{u} u ,绕该轴旋转的角度 θ \theta θ,那么她对应的单位四元数为:
q = [ c o s θ 2 u ⃗ ⋅ s i n θ 2 ] q=\begin{bmatrix} cos\frac{\theta}{2}\\\vec{u}\cdot sin\frac{\theta}{2} \end{bmatrix} q=[cos2θu sin2θ]
当旋转一段微小时间,即旋转角度趋向零时,容易有:
Δ q = [ c o s δ θ 2 u ⃗ ⋅ s i n δ θ 2 ] ≈ [ 1 u ⃗ ⋅ δ θ 2 ] = [ 1 δ θ 2 ] \Delta{q}=\begin{bmatrix}cos\frac{\delta\theta}{2}\\\vec{u} \cdot sin\frac{\delta\theta}{2}\end{bmatrix}\approx\begin{bmatrix}1\\\vec{u}\cdot \frac{\delta\theta}{2}\end{bmatrix}=\begin{bmatrix}1\\\frac{\delta\theta}{2}\end{bmatrix} Δq=[cos2δθu sin2δθ][1u 2δθ]=[12δθ]
其中 δ θ \delta\theta δθ的方向表示旋转轴,模长表示旋转角度。
4)四元数求导数
角速度有:
ω = lim ⁡ Δ t → 0 δ θ Δ t \omega=\lim_{\Delta{t} \to 0} \frac{\delta\theta}{\Delta{t}} ω=Δt0limΔtδθ
四元数对时间的导数为:
q ˙ = lim ⁡ Δ t → 0 q ( t + Δ t ) − q ( t ) Δ t = lim ⁡ Δ t → 0 q ⊗ Δ q − q Δ t = lim ⁡ Δ t → 0 q ⊗ ( [ 1 δ θ 2 ] − [ 1 0 ⃗ ] ) Δ t = q ⊗ [ 1 ω 2 ] \dot{q}=\lim_{\Delta{t} \to 0} \frac{q(t+\Delta{t})-q(t)}{\Delta t}=\lim_{\Delta{t} \to 0} \frac{q\otimes\Delta q -q}{\Delta t}=\lim_{\Delta{t} \to 0} \frac{q\otimes \left( \begin{bmatrix}1\\ \frac{\delta\theta}{2}\end{bmatrix} -\begin{bmatrix}1\\ \vec{0}\end{bmatrix}\right) }{\Delta t}=q\otimes\begin{bmatrix}1\\ \frac{\omega}{2}\end{bmatrix} q˙=Δt0limΔtq(t+Δt)q(t)=Δt0limΔtqΔqq=Δt0limΔtq([12δθ][10 ])=q[12ω]

数学公式参考
四元数求导参考
旋转向量旋转矩阵求导
旋转矩阵与旋转轴转换数学公式
李群李代数历史

###################
好记性不如烂笔头
积跬步期千里
觉得不错的话,记得点赞收藏


http://www.niftyadmin.cn/n/5798962.html

相关文章

STM32第十一课:STM32-基于标准库的42步进电机的简单IO控制(附电机教程,看到即赚到)

一:步进电机简介 步进电机又称为脉冲电机,简而言之,就是一步一步前进的电机。基于最基本的电磁铁原理,它是一种可以自由回转的电磁铁,其动作原理是依靠气隙磁导的变化来产生电磁转矩,步进电机的角位移量与输入的脉冲个数严格成正…

云计算中的容器技术(如Docker)是什么?

今天想和大家聊聊容器技术,特别是Docker这个大家可能经常听到的名词。记得我刚接触容器技术时也觉得挺抽象的,让我用简单的比喻来说明吧。 想象一下你在搬家。传统方式是把所有家具、电器分散装车,到了新家还要重新组装、调试。这就像我们以…

Redis 性能优化的18招

大家好,我是苏三,又跟大家见面了。 前言 Redis在我们的日常开发工作中,使用频率非常高,已经变成了必不可少的技术之一。 Redis的使用场景也很多。 比如:保存用户登录态,做限流,做分布式锁&a…

单机游戏《野狗子》游戏运行时提示dbghelp.dll缺失是什么原因?dbghelp.dll缺失要怎么解决?

《野狗子》游戏运行时提示dbghelp.dll缺失:原因与解决方案 在畅游《野狗子》这款引人入胜的游戏世界时,突然遭遇“dbghelp.dll缺失”的错误提示,无疑会给玩家的探险之旅蒙上一层阴影。作为一名深耕软件开发领域的从业者,我深知此…

vue 集成 webrtc-streamer 播放视频流 - 解决阿里云内外网访问视频流问题

资料&#xff1a; 史上最详细的webrtc-streamer访问摄像机视频流教程-CSDN博客 webrtc目录 前端集成 html文件夹里的webrtcstreamer.js&#xff0c;集成到前端&#xff0c;可以访问webrtc&#xff0c;转换rtsp为webrtc视频流&#xff0c;在前端video中播放 <videoref&quo…

leetcode 面试经典 150 题:螺旋矩阵

链接螺旋矩阵题序号54题型二维数组&#xff08;矩阵&#xff09;解题方法模拟路径法难度中等熟练度✅✅✅ 题目 给你一个 m 行 n 列的矩阵 matrix &#xff0c;请按照 顺时针螺旋顺序 &#xff0c;返回矩阵中的所有元素。 示例 1&#xff1a; 输入&#xff1a;matrix [[1,2,3…

【每日学点鸿蒙知识】沙箱目录、图片压缩、characteristicsArray、gm-crypto 国密加解密、通知权限

1、HarmonyOS 如何创建应用沙箱目录&#xff1f; 下载文件&#xff0c;想下载到自己新建的应用沙箱目录&#xff0c;有什么方法实现吗&#xff1f; fs.mkdir可以创建目录 参考文档&#xff1a;https://developer.huawei.com/consumer/cn/doc/harmonyos-references-V5/js-apis…

微软的AI转型故事

在一次备受瞩目的深度访谈中&#xff0c;微软的CEO萨提亚纳德拉与著名投资人比尔格里和布拉德格斯特纳展开了一场关于微软十年转型与AI未来的深入探讨。这次对话不仅回顾了微软在纳德拉领导下的重大发展轨迹&#xff0c;也为AI时代的战略布局提供了洞见。 纳德拉的职业起点 故…