77范文网 - 专业文章范例文档资料分享平台

基于STM32的四旋翼飞行控制系统毕业设计 - 图文(7)

来源:网络收集 时间:2020-04-17 下载这篇文档 手机版
说明:文章内容仅供预览,部分内容可能不全,需要完整文档或者需要复制内容,请下载word后使用。下载word有问题请添加微信号:或QQ: 处理(尽可能给您提供完整文档),感谢您的支持与谅解。点击这里给我发消息

西华大学毕业设计说明书 度或者角速度。

那能否使用加速度来计算姿态角呢?加速度坐标模型如图6.2所示。

图6.2 加速度坐标模型图

要知道当飞行器只受重力场时,x^2+y^2+z^2 =1g, 向量R是加速度计测量(它可以是引力场或惯性力)的力矢量。Rx,Ry,Rz,分别R在X,Y,Z轴上的矢量投影。有下面的关系式:R^2 = RX^2 + RY^2 + RZ^2。

我们感兴趣的是向量R 和 X、Y、Z轴之间的角度,将它们定义为 Axr、Ayr、Azr。模型图如图6.3所示。可以看到由R 和Rx 组成的直角三角形。

图6.3 重力分量坐标模型图

这里我们可以很容易推导出下面的公式,得到重力向量与各个轴间的夹角,即姿态角。

第 24 页

西华大学毕业设计说明书 COS(Axr)= RX / R 依此类推: COS(Ayr)= RY / R COS(Azr)= RZ / R 当使用arccos()反余弦 : Axr = arccos(RX / R) Ayr = arccos(RY / R) Azr = arccos(RZ / R) 具体而言,就是: cosX = cos(Axr) = Rx / R cosY = cos(Ayr) = Ry / R cosZ = cos(Azr) = Rz / R

这三个公式通常被称为方向余弦。可以很容易地证明: SQRT(cosX ^ 2 + COSY ^ 2 + cosZ ^ 2)= 1

这个特点可以避免记录R矢量的模(长度)。很多时候,只有惯性矢量方向才是真正有用的,对矢量进行规范化对简化程序运算很有意义。

比如,当水平放置MPU6050,只有Z轴感受到重力向量,它将输出1g。对应的ADC值就是16384 (2g的量程)。此时,R就是重力向量,Rx=0. Ry=0. Rz = R =1g. 满足 R ^ 2 = RX ^ 2 + RY ^ 2 + RZ ^ 2 得到重力向量与各个轴的夹角。 Axr = arccos(RX / R) = 90度。 Ayr = arccos(RY / R) = 90度。 Azr = arccos(RZ / R) = 0 度。

这里似乎只需要加速度就可以获得飞行器的姿态角,但飞行器在实际飞行的过程中,由于飞行器本身的摆动、振动或者加速运动时所产生的加速度会对重力加速度产生很大的干扰信号(MPU6050并不能区分哪个是真正需要的加速度),干扰它叠加在应该测量的重力加速度信号上使得输出的数据无法准确反映飞行器的倾角,如图6.4所示。

图6.4 单轴加速度测量值曲线图

图中实线表示MPU6050单轴测得加速度变化量,而虚线表示重力加速度在该轴上

第 25 页

西华大学毕业设计说明书 的分量,可以看出,是有干扰叠加在重力加速度分量信号上的。这些波动噪声可以通过数据平滑滤波将其滤除。但是平滑滤波一方面会使得信号无法实时反映飞行器的倾角变化,进而减缓了程序对于飞行器控制。另一方面也会将飞行器角速度的变化信息滤掉。上述两方面的滤波效果使得飞行器保持平衡的难度加大。

对于角速度而言,它并不会受到飞行器运动的影响,所以该数据中的噪声很小,可以把转动角速度进行积分得到姿态角,这样又可以进一步平滑信号,从而使得到的角度信号更加稳定。但是这存在一个问题,由于从陀螺仪角速度获得角度信息,需要经过积分运算。如果角速度信号存在微小的偏差和漂移,经过积分运算之后,变化形成积累误差。这个误差会随着时间延长逐步增加,最终导致无法形成正确的角度信号。如图6.5所示。

图6.5 角速度积分漂移现象曲线图

图中实线表示由角速度积分后的角度值,虚线表示真实的角度值。可以得到结论,

单单依靠角速度的到的角度无法精确反应飞行器的姿态。如何消除这个累积误差呢? 一种方法就是通过上面的加速度获得的角度信息对此进行校正。通过对比积分所得到的角度与重力加速度所得到的角度,使用它们之间的偏差改变陀螺仪的输出,从而积分的角度逐步跟踪到加速度传感器所得到的角度。

还有一种方法,利用MPU6050的数字运动处理器,即DMP。首先我们需要得到

MPU6050的原始数据(线加速度和转动角速度),然后调用数字运动处理器DMP,将数据进行简单处理后导入DMP,经过DMP内部的姿态算法处理,会输出一组四元数。四元数其实是旋转另一种的表示方式,这里不做详细介绍。DMP输出的四元数是q30格式的,也就是浮点数放大了2的 30次方倍。必须先将其转换为浮点数,再除以2的30次方,计算公式为:

q0 = quat[0] / q30; // q30=1073741824.0f q1 = quat[1] / q30; q2 = quat[2] / q30; q3 = quat[3] / q30;

在得到四元数之后,还需要根据四元数到欧拉角的转换公式计算出欧拉角,即得到yaw、roll和pitch。公式如下:

第 26 页

西华大学毕业设计说明书 pitch = asin(-2 * q1 * q3 + 2 * q0* q2)* 57.3;

roll = atan2(2 * q2 * q3 + 2 * q0 * q1, -2 * q1 * q1 - 2 * q2* q2 + 1)* 57.3; yaw = atan2(2*(q1*q2 + q0*q3),q0*q0+q1*q1-q2*q2-q3*q3) * 57.3;

同样的,我们用杜邦线把GY-86模块(模块上载有MPU6050芯片)接入单片机,先让单片机接收MPU6050原始数据,并把数据做一系列的处理并送入DMP,再根据以上两个公式对DMP的数据做进一步的处理,最后将计算出的欧拉角yaw、roll和pitch显示在TFT屏幕上,方便观察和分析。模块连接图如图6.6所示。

图6.6 模块连接图

将GY-86模块按不同倾角摆放,具体如下表6.7所示。

表6.7 DMP测试

GY-86模块状态 TFT显示 说明 X坐标轴-roll绕动 Y坐标轴-pitch绕动 Z坐标轴-yaw绕动 GY-86依靠三角板的30角,X轴平行于斜边。即绕Y轴逆时针转动,所以pitch为-30度。 第 27 页

西华大学毕业设计说明书 X坐标轴-roll绕动 Y坐标轴-pitch绕动 Z坐标轴-yaw绕动 GY-86依靠三角板的60角,Y轴平行于斜边。即绕X轴顺时针转动,所以roll为60度。 X坐标轴-roll绕动 Y坐标轴-pitch绕动 Z坐标轴-yaw绕动 GY-86依靠三角板的30角,Z轴垂直于斜边。即绕Z轴顺时针转动,所以yaw为30度。 的欧拉角。 6.2.3 数据中断

从表6.7 DMP测试里可以看出,利用DMP进行姿态解算,可以准确地得出飞行器

虽然我们可以通过DMP模式获取正确的欧拉角,但是应该在什么时候去读取DMP的四元数呢?因为DMP模式下这要的数据都是存储在MPU6050里面的FIFO,FIFO里面存的包括GYRO,ACC,四元数等参数。并且DMP里面的数据只能从FIFO读取的, DMP库里的做法是:FIFO里数据过半满时,会发出冲洗FIFO指令。当FIFO数据不足时,会延时等待。如果我们读取早了,可能获取的是上一次的数据,也可能DMP正在

第 28 页

百度搜索“77cn”或“免费范文网”即可找到本站免费阅读全部范文。收藏本站方便下次阅读,免费范文网,提供经典小说综合文库基于STM32的四旋翼飞行控制系统毕业设计 - 图文(7)在线全文阅读。

基于STM32的四旋翼飞行控制系统毕业设计 - 图文(7).doc 将本文的Word文档下载到电脑,方便复制、编辑、收藏和打印 下载失败或者文档不完整,请联系客服人员解决!
本文链接:https://www.77cn.com.cn/wenku/zonghe/987604.html(转载请注明文章来源)
Copyright © 2008-2022 免费范文网 版权所有
声明 :本网站尊重并保护知识产权,根据《信息网络传播权保护条例》,如果我们转载的作品侵犯了您的权利,请在一个月内通知我们,我们会及时删除。
客服QQ: 邮箱:tiandhx2@hotmail.com
苏ICP备16052595号-18
× 注册会员免费下载(下载后可以自由复制和排版)
注册会员下载
全站内容免费自由复制
注册会员下载
全站内容免费自由复制
注:下载文档有可能“只有目录或者内容不全”等情况,请下载之前注意辨别,如果您已付费且无法下载或内容有问题,请联系我们协助你处理。
微信: QQ: