姿态描述—四元数,旋转矩阵以欧拉角

写在前面

上一篇博客中讲解了IMU的几个模块的基本原理,对于陀螺仪来说我们获取到的是物体运动的角速度,相信有高数基础的同学都很容易想到角速度对时间积分后就能得到三轴的角度。这便是最接近我们思维的一种表达方式——欧拉角。

欧拉角

有一个动图很形象的表达了欧拉角的概念

v2-5480232b0c74e8d236044529bd170834_b.gif

在图片中绕x轴水平旋转的是横滚角Roll,第二次旋转是俯仰角Pitch,最后的称为偏航角Yaw。是不是感觉超级简单,十分直观符合我们日常的习惯。但是欧拉角描述刚体旋转会遇到一个著名的万向节锁问题,具体详细的介绍请移步下面连接
https://www.matongxue.com/madocs/442.html

旋转矩阵

旋转矩阵对于有线性代数基础的同学一定不陌生了


20170323174605746.png

简单点来说,一个向量从x坐标系变换到y坐标系,根据坐标系的定义有:

20190220110049.png

稍作变换
20190220110218.png

这里的R便是旋转矩阵了。
具体的绕x轴旋转,绕y轴旋转及z轴旋转还请移步下面博客。
https://blog.csdn.net/csxiaoshui/article/details/65446125

四元数

目前已经有了欧拉角和旋转矩阵两种描述方法,为什么数学家们要提出四元数的概念呢?它是为了解决这两个问题
1. 欧拉角的万向节锁问题
2. 旋转矩阵的9个数值不相互独立。
首先万向节锁相信大家看过博客都基本了解了,那旋转矩阵9个数值不独立指什么呢?
不独立我这里指的是有约束,比如旋转矩阵有R 等于R的转置的特性,导致它各个变量有相互约束的问题给后期求解带来了很多麻烦。这时,四元数应运而生四个变量相互独立而且避免了万向节锁问题,因而广泛采用。具体的四元数的定义运算及旋转的表达法,请参考下面博客,避免重复造轮子。
https://www.zhihu.com/question/23005815

李群李代数

目前我们采用四元数已经能很好的表达旋转了为什么又要引入这么抽象的概念呢?关键在于求导数,旋转矩阵的变换以及四元数的旋转变换都是乘法,但是学过微积分的同学都知道积分和微分的基础是加法。也就是说旋转矩阵无法对旋转求导(工程上很多时候都是取两次差值作为导数),伟大的数学家注意到对数能将乘法变成加法

20190220112033.png

所以对旋转矩阵取ln后得到新的表达方法,这时便可以对旋转求导数了。当然这部分内容比较抽象,知识有限很难讲透彻,有兴趣的参考高翔博士的博客
https://www.cnblogs.com/gaoxiang12/p/5137454.html

小节

本次大致了解了旋转的多种表达方法,大多参考网上资料也还是属于基础知识与内容。后面就要开始实际用学到的知识去解算IMU的姿态了,但是有一个问题。陀螺仪能解算姿态,加速度计也行,磁力计也ok,那么我们怎么得到最优解呢?下一篇真正开始数据融合。

后期内容

从互补滤波推导到卡尔曼滤波
AHRS算法推导及代码实现(上)
AHRS算法推导及代码实现(下)

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 159,219评论 4 362
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 67,363评论 1 293
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 108,933评论 0 243
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 44,020评论 0 206
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 52,400评论 3 287
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 40,640评论 1 219
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 31,896评论 2 313
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 30,597评论 0 199
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 34,327评论 1 244
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 30,581评论 2 246
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 32,072评论 1 261
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 28,399评论 2 253
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 33,054评论 3 236
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 26,083评论 0 8
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 26,849评论 0 195
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 35,672评论 2 274
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 35,585评论 2 270

推荐阅读更多精彩内容