使用MPU6050硬件DMP解算姿态是非常简单的，下面介绍由三轴陀螺仪和加速度计的值来使用四元数软件解算姿态的方法。 我们先来看看如何用欧拉角描述一次平面旋转(坐标变换)： 设坐标系绕旋转α角后得到坐标系,在空间中有一个矢量在坐标系中的投影为,在内的投影为由于旋转绕进行，所以Z坐标未变，即有。 转换 ...
分类：
其他好文 时间：
2020-02-02 19:56:11
阅读次数：
116
罗德里格斯旋转公式是通过反对称矩阵求旋转矩阵的方法，起初我在看别人写的姿态解算分析文章里看到，他的推导如下：关于罗德里格斯公式的简单推导 请注意我做标记的地方，我刚开始一直不明白这种推导，这样会有误差的推导，难道罗德里格斯公式是对旋转矩阵Ｒ的近似？这样做并不好，反而会使解算的姿态更不准确，后来在群里 ...
分类：
其他好文 时间：
2018-09-29 23:51:51
阅读次数：
290
先上效果图，webots下仿真，四足机器人在转动平台上保持机身水平。 下面是姿态解算方法和控制策略： 如下图所示，给定机器人在世界坐标系的机身位置O’(x’,y’,z’)和航海角（roll、pitch、yaw），以及足部末端在世界坐标系下的位置P1、P2、P3、P4点的坐标。我们需要求解的是P1、P ...
分类：
其他好文 时间：
2018-05-10 23:29:14
阅读次数：
479
AHRS(attitude and heading reference system)称为航姿参考系统。 首先，我们明确一下四元数的知识。 四元数（quaternion）是由我们的威廉·哈密顿提出的。哈密顿就是那个‘哈密顿最小作用原理’的提出者。 四元数可视为复数的扩展。在复数中，定义了，而四元数中 ...
分类：
编程语言 时间：
2017-12-18 12:11:20
阅读次数：
3829
一、开篇 慢慢的、慢慢的、慢慢的就快要到飞控的主要部分了，飞控飞控就是所谓的飞行控制呗，一个是姿态解算一个是姿态控制，解算是解算，控制是控制，各自负责各自的任务。我也不懂。还在学习中~~~~ 近期看姿态预计部分看的太累了，明显发现基础知识太薄弱，什么欧拉角、DCM、四元数、gyro误差、矫正、正交化 ...
分类：
其他好文 时间：
2017-07-22 19:52:47
阅读次数：
1171
//欧拉角转四元数voidcjx_from_euler(floatroll,floatpitch,floatyaw){floatcr2=cosf(roll*0.5f);floatcp2=cosf(pitch*0.5f);floatcy2=cosf(yaw*0.5f);floatsr2=sinf(roll*0.5f);floatsp2=sinf(pitch*0.5f);floatsy2=sinf(yaw*0.5f);q1=cr2*cp2*cy2+sr2*sp2*sy2;q2=sr2*cp2*cy2..
分类：
其他好文 时间：
2016-11-12 20:20:36
阅读次数：
363
使用MPU6050硬件DMP解算姿态是非常简单的，下面介绍由三轴陀螺仪和加速度计的值来使用四元数软件解算姿态的方法。 我们先来看看如何用欧拉角描述一次平面旋转(坐标变换)： 设坐标系绕旋转α角后得到坐标系,在空间中有一个矢量在坐标系中的投影为,在内的投影为由于旋转绕进行，所以Z坐标未变，即有。 转换 ...
分类：
其他好文 时间：
2016-08-15 18:53:28
阅读次数：
459
0 引言
在捷联惯导工程实践[6]中，我们希望陀螺仪能够非常精确的获取信息，或者说希望陀螺仪能非常准确的地反映观测量（加速度，磁场等）[6,7]的真实值，但是这个过程或多或少是受到噪声干扰的，导致测量的不准确；为了能够让陀螺仪在状态更新时做到准确，必须对状态变量和观测量进行数据融合和滤波，从而尽最大限度的降低噪声的干扰。
最常用也最有效的方法非卡尔曼滤波莫属，其在处理高斯模型的系统上效果颇...
分类：
其他好文 时间：
2016-06-21 07:14:42
阅读次数：
504
本例程输出XYZ的角度，感觉算是比较稳定，但好像有点偏移。
首先看看XYZ轴的输出效果图:
Bom表
Arduino Uno *1
mpu6050 陀螺仪模块 *1
跳线 若干
Arduino uno+MPU6050接线方式如下
首先要更新I2C库
在GIT...
分类：
其他好文 时间：
2016-05-10 12:57:14
阅读次数：
811
