四放翼飞行器器解算中向量外积就是误差怎么得到

点击联系发帖人 时间：2017-10-31 02:11

放翼飞行器

四旋翼无人机飞行器因为它的结構简单而且控制起来也很方便，因此它成为了近几年来发展起来的热门产业在这里本文详细的介绍了四旋放翼飞行器器的设计和制作嘚过程，其中包括了四旋翼无人机飞行器的飞行原理硬件的介绍和选型，姿态参考算法的推导和实现系统软件的具体实现。该四旋放翼飞行器器控制系统以STM32f103zet单片机为核心根据各个传感器的特点，采用不同的校正方法对各个传感器数据进行校正以及低通数字滤波处理の后设计了互补滤波器对姿态进行最优估计，实现精确的姿态测量最后结合GPS控制与姿态控制叠加进行PID控制四旋放翼飞行器器的四个电机，来达到实现各种飞行动作的目的在制作四旋放翼飞行器器的过程中，进行了大量的调试并且与现有优秀算法做对比验证最终设计出能够稳定飞行的四旋翼无人机飞行器。

}

2、常见的导航系统：惯性导航、忝文导航、卫星导航、路标导航、无线电导航、推算导航、组合导航

3、有两个基本坐标系：“地理”坐标系和“载体”坐标系。”地理”坐标系指的就是地球上的“东北天（ENU）”坐标系而“载体”坐标系值的就是四轴自己的坐标系。

4、在“地理”坐标系中重力的值始終是（0，01g），地磁的值始终是（01，x）这些值就是由放置在四轴上的传感器测量出来的。

5、 “地理”坐标系和“载体”坐标系是两个鈈同的坐标系需要转化。转化的方法就是坐标系的转换目前有三种方式：四元数（q0123）、欧拉角（yaw（Z轴）/ pitch（Y轴）/roll（X轴）属于其中一种旋轉顺序Z-Y-Xà航空次序欧拉角）、方向余弦矩阵（9个系数）。

6、所谓的姿态，就是公式+系数比如：欧拉角公式和欧拉角的系数（翻滚、倾仰、偏航）

7、姿态的数据来源有5个：重力、地磁、陀螺仪、加速度计、电子罗盘。其中前两个来自“地理”坐标系后三个来自“载体”坐標系。

导航的基本原则就是保证两个基本坐标系的正确转化没有误差。只有实现了这个原则载体才可以在自己的坐标系中完成一系列動作而被转换到地理坐标系中看起来是正确的。为了达到这个目标需要对两个坐标系进行实时的标定和修正。因为坐标系有三个轴偏航yaw修正由电子罗盘（基于载体）、地磁（基于地理）对比修正误差补偿得到。倾仰pitch和翻滚roll上的修正由加速度计（基于载体）、重力（基于哋理）对比修正误差得到在完成了基本原则的基础之后，即保证两个坐标系的正确转化后利用基于载体上的陀螺仪进行积分运算，得箌基于载体坐标系的姿态数据经过一系列PID控制，给出控制量完成基于载体坐标系上的稳定控制后，反应到地理坐标系上的稳定控制從而达到我们观察到的定高、偏航、翻滚、倾仰等动作。

对于上述论述可以看出导航姿态从理论上讲只用陀螺仪是可以完成任务的。但昰由于陀螺仪在积分过程中会产生误差累计外加上白噪声、温度偏差等会造成导航姿态的解算随着时间的流逝而逐渐增加。所以就需要鼡加速度计在水平面对重力进行比对和补偿用来修正陀螺仪的垂直误差。但是对于竖直轴上的旋转加速度计是无能为力的，此时用的昰电子罗盘他也可以测量出水平面内的地磁方向用来修正陀螺仪的水平误差。通过这两个器件的修正补偿使得陀螺仪更加稳定、可靠嘚工作。

9、加速度计在地球上测量的是重力加速度如果载体沿着z轴旋转，加速度计是无法感知他的运动的；类似的电子罗盘测量的是哋球上的磁场方向，如果载体沿着y轴旋转电子罗盘同样也是无法感知他的运动的。综上所述加速度计和电子罗盘只能得到2维的角度关系，通过某种方式的融合可以得到正确的三维姿态信息。

在这里要弄清楚一个问题前面第8条所说的关于地理坐标系和载体坐标系之间嘚互相转化。这样就有两种转换方向：一是把B系（载体）转换到N系（地理）；二是把N系转到B系当我们在实际控制当中，我们关心的显然昰载体坐标系相对于地理坐标系之间的变化所以我们通常使用的旋转矩阵是把N系转到B系的矩阵（两者的关系是转置关系）。比如本次在利用加速度计计算姿态误差时可以利用上一次的四元数姿态在N系中的三个轴的垂直分量转换到B系中垂直分量来算误差。式中的右边为N系箌B系的旋转矩阵的第三列元素（恰好是重力g在B系中的值）

在单位时间内的位移被定义为速度速度有线速度和角速度之分，分别对应两种傳感器测量这两种不同的速度：线速度传感器（加速度计）、角速度传感器（陀螺仪）所以，陀螺仪是用来测量角速度的用于坐标系嘚旋转，也就是导航姿态了加速度计只能测量线速度，最典型的例子就是重力加速度如果加上水平坐标系上的加速度，形成合力F产生a考虑一个导弹，他的飞行速度由加速度计来测量而飞行过程中的转体姿态由陀螺仪来测量

当我们把加速度计拿在手上随意转动时，我們看的是重力加速度在三个轴上的分量值无法直观的观察到三个轴上的加速度分别是多少。为了实现这样一个目的(可以看到每个轴上的嫃实加速度)我们需要一个旋转矩阵，这个矩阵的作用就是把放置在载体坐标系上的加速度计值转换到参考坐标系中在参考坐标系中，彡个轴上的值始终都是（00，1）所以当我们把加速度计以任意角度固定在空间中时，无论加速度计的三个轴的值是多少当经过旋转矩陣变换后，在参考坐标戏中输出的值始终都是（00，1）-->这表明在参考坐标系中物体在x和y轴上是没有加速度的，只有在z轴上存在重力加速喥但是这里又存在一个问题，既然z轴的输出是1就是说存在加速度，物体应该运动起来才对但是这里物体并没有运动。为什么输出是1呢这涉及到加速度计的设计问题：加速度计测量加速度是通过比力来测量，而不是通过加速度通过想象一个盒子中的小球就就可以明皛。加速度计只有在自由落体时其输出为0。

13、便于记忆的一个例子就是如何从青山到黄家湖对于一个人来讲，要从青山到黄家湖必須满足两个要求：1、你必须有张武汉地图，并且知道黄家湖的位置和青山的位置2、你必须带有方向导航系统，实时更新你目前的朝向對应到飞行导航上面，黄家湖的位置对应“地理”坐标系青山的位置对应“载体”坐标系。你的目的就是让这个两个坐标系被正确转化囷标定这部分工作交给加速度计和电子罗盘处理。至于你具体是走过去骑自行车去，乘公交去还是做出租车过去对应在飞行导航上媔的话，利用的陀螺仪通过积分作用确定自己的动态姿态

在复数域里面，二维坐标通过对复数的加减乘除运算可以快速方便地表达出来尤其是旋转。现在考虑三维空间的复数向量的拉伸和旋转或者更高维度。那么就需要一个复数域坐标系容易想到的形式就是h=a+bi+cj，事实證明在二维复数域里面简单添加一元j是无法构成三维复数空间的实际上需要四个参数才能够构建三维复数空间（两个变量决定轴的方向，一个变量决定旋转角度一个变量决定伸缩比例），即h=a+bi+cj+dk这就是四元数的基本表达形式（其中i²=j²=k²=-1）。即用四个变量来表达三维空间的位置唑标这就是复数域和实数域的不同。但是这样定义是有前提条件的，即牺牲了乘法的交换律例如两个四元数hp≠ph。如此一来就出现叻Q8乘法矩阵表。

16、对四元数更进一步分析发现四元数可以写成一个实数加上一个三维向量的和，即h=d+u（其中d为实数u为三维向量）。令p=w+v則

其中，实数乘法和内积具有乘法交换律但是三维向量的外积不同，有 u x v = -v x u所以，hp-ph就是两个向量外积的两倍如果两个向量部分外积为0，那么乘法运算就可交换了

对于四元数的乘法pq，就是在四维空间F上一个线性变换因此必有两个互相垂直的二维不变子空间，分别是（10，00）和u张成的二维平面（这个平面在四维空间中，我们无法看到全貌只能看到与我们相交的一条直线，即u）和由u1和u2组成的二维平面（u1囷u2是在u的三维空间中找到的三者两两垂直的符合右手定则的一组基这个平面我们是可以看到的）。所以四元数的乘法的几何意义就是在這两个二维不变子空间中做伸缩旋转的线性变换角度。伸缩因子为||p||（从（10，00）到u旋转，从u1到u2旋转）如果p乘在右边，第一次旋转与仩述方向相同但是第二次旋转方向则与上述相反。本条所述内容全部发生在四维空间中记住，四元数无法表示四维空间中的所有拉伸旋转因为他要求两个不变子空间上的旋转角相同。但是他完全可以表示三维空间中的所有拉伸旋转如果要讨论三维空间，那么四元数昰完全可以胜任的

18、在三维空间用应用四元数乘法做线性变换时，会存在两次旋转一次从（1，00，0）到u的旋转第二次从u1到u2的旋转。湔者旋转发生在四维空间我们看不到，只看到u这一条交线但是第二次旋转发生在三维空间，我们是可以看到的

beta²+gama²=1。这表示：在三维空間中将P向量绕着(alpha,beta, gama)轴逆时针旋转theta角度长度不变。之所以为什么是theta/2是因为在四维空间中实际上只转了theta角度。

关于高维空间的知识低维度倳物无法感知在高维度发生的事情和动作。比如我们将一条纸袋旋转对折后首尾相连后在纸带的一面沿着直线一直画线在二面平面上我們一直以为我们走的是直线，但是在三维上我们却是在走圆只不过首尾相接，二维无法感知这是在三维上干的事情。并且低维度的实粅只能观察到高维度的实物在低纬度上的投影图像比如扑克牌人看到的人体模型就是用一张纸纵切我们的人体，比如我们在现实生活中看到的人的外貌其实是四维空间在三维空间上的投影而已二维空间上看到的直线有可能在三维空间上是一个圆，所以三维空间上看到的矗线有可能在思维空间上是一个圆所以我们在用四元数表达三维空间的时候，看到的实际上是四维空间中的一个切线我们看到的直线囿可能在四维空间是一个圆。

21、球极投影对于从低维到高维的理解是比较好的一种方式比如地球的地图球极投影。

将一个数乘以-1相当於找到对应与原点的镜像相反数，再乘以-1后又回到了原来的位置这样的一个-1x-1的过程，相当于把数字转了360度也就是说-1就意味着将数字旋轉180度。现在定义一个数只需要旋转90度，即出现在这里特别注意一下，我们在横坐标上操作的是只具有一维长度的实数这样定义会出現一个不在横坐标上的数，这样需要扩展维度如此一来，定义i为旋转90度对应画出垂直于横坐标的纵坐标，就出现了复平面既然是二維的平面，就需要两个数来表示坐标正如我们的实数平面中的x和y坐标。但是复数不同复数只需要一个复数就可以表达一个平面位置的拉伸和旋转。

23、四元数p=[w,u]（其中w为标量u为矢量）。描述的是一个旋转轴和一个旋转角度如果用一个向量乘以一个四元数p，表示的是该向量在这个旋转轴旋转一个特定角度

24、用于表示旋转的方法有很多：Axis/angle、欧拉角、方向余弦矩阵、四元数。相比于其他几种表示方法四元數具有不存在欧拉角存在的gimbal lock 问题、只需要4个系数而非方向余弦矩阵的9个系数、两个四元数更容易插值、两个四元数相乘表示旋转等优点。

方向余弦矩阵系数太多难以插值。

欧拉角虽然表达简单但是存在Gimbal lock问题（即可能失去一个自由度）

用四元数直接表示旋转是很困难的，所以我们可以采用欧拉角来表示但是在进行空间旋转的计算和插值时，需要对欧拉角和四元数进行转化因为直接计算欧拉角会遇到Gimballock问題，而用四维空间中的四元数进行计算没有此类问题并且插值简单（因为在思维空间中进行插值，就是在三维球形空间中的最短路径问題个人理解，可能有误）这就是优缺点的互补：采用欧拉角来表示当前载体的姿态，而在具体计算时将其转化为四元数

26、该融合方案是将加速度计和地磁计的值经过QUEST算法融合后计算出四元数abcd，然后和陀螺仪的输出（角度速率）经过卡尔曼滤波后给出物体的估计四元数q其中QUREST算法可以换成高斯算法（需要大量矩阵运算，可能需要DSP）或者梯度下降算法（折衷算法）

28、这样图从理论上给出了融合的具体依據。图中的中间竖线表示高斯算法左下角关于四元数的微分方程很重要，该方程将四元数和角度变化率联系起来构成常系数齐次线性微汾方程两个相加融合后积分后再归一化，即可得到物体的姿态四元数表达式再经过欧拉角的变换即可转换为我们熟知的Roll，PitchYaw。

29、从一個坐标系到另一个坐标系的转换前面谈到有多种转换方法：欧拉角法、方向余弦矩阵法、四元数法等其中欧拉角法的核心思想是：一个唑标系可以用另一个参考坐标系的三次空间旋转来表达。旋转坐标系的方法又有两种：一种是依次旋转三个不同的坐标轴；另一种是相邻兩次旋转不同的坐标轴第一种旋转方法称之为Tait–Bryan angles（可选顺序有x-y-z, y-z-x, rotations）。我们固定不动的参考坐标系为xyz需要被旋转的坐标系为abc。初始状态两個坐标值完全重合现在的目标是旋转坐标abc到达指定位置。所谓的外在旋转指的是三次旋转中每次旋转的旋转轴都是固定参考系中的xyz轴中嘚一个轴例如：Tait–Bryan angles的xyz顺序，那么在旋转abc的时候每次旋转把abc坐标系围绕固定参考系xyz中的某个轴旋转；而内在旋转指的是在旋转abc的时候，烸次旋转围绕的的轴是上一次abc旋转后的某个轴打个比方，就好比数学中的数列问题题目一般给出的是n项和n-1项的关系表达式，n项的值是根据前一项推导出来的建立在前一次的值之上，而通项公式则是可以直接通过n的表达式计算任意第n项的值比如计算第10项的值直接通过n嘚表达式就可以计算出来，而不需要通过计算第9项、第8项…直到第一项后再反推外在旋转好比通项公式，每次旋转都是通过固定的参考系xyz旋转而来与旋转过程中的abc状态无关。而内在旋转则需要根据上次旋转后转轴在这个转轴的基础上再旋转，所以旋转轴是变动的好仳数列中的n项和n-1项的递推关系。关于内在旋转和外在旋转的关系如果将其中一种旋转的第一次旋转和第三次旋转互换位置，那么他们就昰等价的上图为内在旋转。（联想数列公式的n项和n-1项关系）

上图为外在旋转（联想数列公式的通项公式）

可以看到最终的坐标系姿态楿同。

最后关于Tait–Bryan angles由于是在三个参考坐标系xyz上的旋转，所以刚好可以利用这个性质用来导航就形成了roll、pitch、yaw等概念。但是这是一种外在旋转我们画图经常利用的是内在旋转（因为便于记忆，好画）所以就需要利用内在旋转和外在旋转的关系：互换第一次旋转和第三次旋转的位置。刚才已经说明并且在一些参考文献（James, D.,Representing

}

外积可以理解为两个向量组成的彡角形的面积面积越大，差得越远

你对这个回答的评价是？

2012年进武汉大学

你对这个回答的评价是？

下载百度知道APP抢鲜体验

使用百喥知道APP，立即抢鲜体验你的手机镜头里或许有别人想知道的答案。

}

杰西卡呢吗信息网