1.参考资料
2.旋转矩阵的性质
2.1旋转矩阵
2.2旋转矩阵的奇异点
2.3旋转矩阵的微分方程
3.向量叉乘与斜对称矩阵
4.四元数
4.1四元数表示
4.2四元数乘法
4.3四元数的性质

1.参考资料

Quaternion kinematics for the error-state KF
barfoot《state estimation forrobotics》
袁信、郑锷《捷联式惯性导航原理》
以上书籍的下载链接链接：http://pan.baidu.com/s/1c1G0k5U 密码：jdsz

2.旋转矩阵的性质

2.1旋转矩阵

定义frame1到frame2的旋转矩阵为C21C21，旋转矩阵是单位正交矩阵。
对于旋转矩阵的下标可以这样理解，等式右边是旋转矩阵转化后的新位置坐标，左右是上一时刻的位置坐标,因此旋转的叠加（积分）即在原来的基础上再左乘新的旋转矩阵。
z-y-x即图中3-2-1，是我看很多导航的书的表示方式，barfoot的书中以1-2-3旋转方式作为航空中常用的旋转方式，对比袁信的捷联惯导书和barfoot的书，两者每次旋转对应的旋转矩阵C1,C2,C3C1,C2,C3是相通的，只不过定义的旋转次序不同使得旋转矩阵的形式不太一样
-欧拉角的大小和方向定义：
barfoot书中每次旋转的旋转矩阵定义，和袁信书中一致。
以袁信书中的z-y-x即3-2-1的旋转方式表示的旋转矩阵，,这里frame1看作是n系，frame2看作是b系，则导航系n到机体系b的旋转矩阵C21=Cbn=（Cnb）−1=C1C2C3C21=Cnb=（Cbn）−1=C1C2C3
旋转矩阵的小角度表示：当旋转角都比较小时，利用三角函数的与欧拉角的近似,省略小量的二次以上部分，得到：

2.2旋转矩阵的奇异点

barfoot书中以1-2-3的旋转方式为例，如果中间那次旋转θ2=π2θ2=π2，则旋转就会变成绕1轴旋转θ1+θ3θ1+θ3,即旋转耦合在一起，即这次旋转的欧拉角无法恢复。

2.3旋转矩阵的微分方程

哥氏定理
利用哥氏定理推导旋转矩阵的微分方程

3.向量叉乘与斜对称矩阵

向量叉乘可以表示成向量的叉乘矩阵和向量相乘，叉乘矩阵是斜对称矩阵,这种表示在旋转相关公式里经常用到。对于列向量a,b有：

4.四元数

4.1四元数表示

四元数有很多表示方法，这里采用标量+向量的形式表示（scalar+vector）

4.2四元数乘法

两个四元数等于各个元素分别相乘，表示旋转的积分
四元数乘法不满足交换律(commutative)
四元数乘法满足结合律(associative)和分配律(distributive)
两个四元数相乘可以表示为矩阵的形式
利用四元数的结合律得到

4.3四元数的性质

单位1 四元数(Identity):
共轭四元数：虚数部分符号相反
单位四元数的逆等于其共轭四元数

转载于:https://www.cnblogs.com/youzx/p/6327418.html

四元数运动学笔记（1）旋转的表示相关推荐

四元数绕某个轴旋转某度之后的得到的四元数+pcl使用总结
四元数绕某个轴旋转某度之后的得到的四元数 //2.2 由四元数得到旋转轴tf::Vector3 v5(0,0,1);//v5=q.getAxis();std::cout<<"四元 ...
文章翻译—基于误差状态卡尔曼滤波器的四元数运动学—前言
基于误差状态卡尔曼滤波(ESKF)的四元数运动学文章作者:Joan Sol`a 发表时间:October 12, 2017(注:Quaternion kinematics for the error ...
机器人学之运动学笔记【3】—— 机械臂DH表示法+正向运动学（Forward Kinematics）
机器人学之运动学笔记[3]-- 机械臂DH表示法+正向运动学(Forward Kinematics) 1. 手臂几何描述方式 2. 改进DH法描述机械臂 2.1 在连杆上建立Frame 2.2 D- ...
文章翻译—基于误差状态卡尔曼滤波器的四元数运动学—第4章
文章目录基于误差状态卡尔曼滤波器的四元数运动学 4. 扰动,导数和积分 4.1 SO(3)SO(3)中的加法和减法运算符 4.2 四个可能的导数定义 4.2.1 从向量空间到向量空间的函数 4.2. ...
误差卡尔曼中的四元数运动学-第二章
第二章旋转和交叉关系 2.1 三维矢量旋转公式公式54的向量旋转公式,是从向量分解的角度推导来的,对于一个旋转来说,就是可以分解为垂直方向和平行方向. 2.2 旋转群SO(3) 在机器人中,刚体的 ...
四元数学习笔记（一）：初识四元数
1 四元数的定义 1.1 为什么要使用四元数旋转向量用 9 个量来描述 3 个自由度的旋转,具有冗余性:欧拉角和旋转向量是紧凑的,但是具有奇异性.事实上,我们找不到不带奇异性的向量描述方式. 回忆之 ...
机器人学之运动学笔记【4】—— 逆向运动学（Inverse Kinematics）
机器人学之运动学笔记[4]-- 逆向运动学(Inverse Kinematics) 1. 逆向求解概念 1.1 了解 1.2 Reachable workspace & Dexterous w ...
Quaternion and isoclinic rotation explaining more (四元数和等倾旋转)
Quaternion and isoclinic rotations: explaining more (四元数和等倾旋转) 文章目录 I 四维空间中的旋转表示 II 四元数描述的三维空间中的旋转计算 ...
机器人运动学笔记3——林沛群
提示:本文上接机器人运动学笔记2--林沛群文章目录前言一.机械手臂轨迹规划 1.1 机械手臂轨迹规划引言 1.2 Joint-Space下轨迹规划 2.3 Cartesian-Space下轨迹 ...

四元数运动学笔记（1）旋转的表示

1.参考资料

2.旋转矩阵的性质

2.1旋转矩阵

2.2旋转矩阵的奇异点

2.3旋转矩阵的微分方程

3.向量叉乘与斜对称矩阵

4.四元数

4.1四元数表示

4.2四元数乘法

4.3四元数的性质

四元数运动学笔记（1）旋转的表示相关推荐

最新文章

热门文章