技术应用

教你用互补滤波算法测量两轮平衡车的姿态角度

发布时间:2015-02-03 00:00:00 责任编辑:sherryyu

【导读】本文基于互补滤波算法,设计了两轮平衡车姿态角度测量电路与数据处理算法,设计了信号滤波预处理,利用互补滤波算法融合两种传感器数据,分析了互补滤波算法中关键参数的计算方法。并将此方法应用于两轮平衡车角度测量,进行了验证性试验,给出了实验测试数据。
 
两轮平衡车具有广阔的应用前景, 使其成为了当前研究的热点。其中,两轮平衡车的姿态角度测量是研究的关键问题之一。姿态角度测量是两轮平衡车运行和控制实现的前提。姿态角度测量的精度和速度,将直接影响两轮平衡车控制算法的稳定性和可靠性。随着惯性测量元件的微型化与微处理器运算能力的提高,两轮平衡车姿态测量普遍采用低成本的惯性测量组合元件(Inertial Measurement Uint,IMU),结合微处理器数据处理算法实现高精度的姿态测量。IMU 主要由低成本的MEMS 陀螺仪和三轴加速度计组成。MEMS 陀螺仪有自主性好、功耗低、机电性能好易集成等优点。但是,MEMS 陀螺仪具有温度漂移特性,其测量误差会随着时间的累加而不断的累积,从而影响测量精度。加速度计会受到平衡车振动的影响,混叠额外的振动量干扰。所以单一的传感器测量难以得到精确的姿态角度。需采用多传感器信号融合的方法,来获得准确的姿态角度量。
 
多传感器数据的融合方法有神经网络、小波分析、卡尔曼滤波等姿态解算算法,但这些方法建立稳定可靠的更新方程通常具有较高的阶数,且计算量大,不适合于低运算能力系统的实时计算。相比以上方法,互补滤波算法对处理器运算速度要求不高,且简单可靠。本文基于互补滤波算法,设计了两轮平衡车姿态角度测量电路与数据处理算法,设计了信号滤波预处理,利用互补滤波算法融合两种传感器数据,分析了互补滤波算法中关键参数的计算方法。并将此方法应用于两轮平衡车角度测量,进行了验证性试验,给出了实验测试数据。
 
1 姿态角度测量原理
 
沿平衡车3 个机体轴即直立时正前、正右、正上方向定义为x、y、z 三轴参考坐标系。所受的3 轴重力加速度分量定义为gx、gy、gz。假设两轮平衡车处于静止或匀速运 行的状态。得到重力加速度与平衡车姿态角度的关系如式1所示:
教你用互补滤波算法测量两轮平衡车的姿态角度
其中,Cbn为惯性坐标系到载体坐标系的变换矩阵;θ 为俯仰角;φ为横滚角;g 为重力加速度; 可以通过测量重力加速度分量gx、gy、gz,计算出平衡车俯仰角θ1和横滚角φ1估计值
教你用互补滤波算法测量两轮平衡车的姿态角度
若使用陀螺仪来测量平衡车姿态角度,设陀螺仪测量载体相对惯性坐标系的x、y、z 三轴旋转角速度分别为ωx、ωy、 ωz。并定义0 时刻平衡车直立静止。可得到俯仰角θ2和横滚角φ2估计值与ωx、ωy之间的关系如式3 所示:
教你用互补滤波算法测量两轮平衡车的姿态角度
在实际应用中,由于平衡车机体运行时存在运动加速度、测量噪声, 以及陀螺仪本身存在漂移等因素的影响, 式(2)、(3)姿态角度测量方法失效,为了准确的获得姿态角度。可将以上的2 种姿态角度测量得到的姿态角度信息相融合。
 
2 惯性组合测量电路
 
该系统中惯性组合测量电路如图1 所示, 由加速度计MMA7361、陀螺仪ENC-03 及放大电路组成。实现对加速度计和陀螺仪测得信号进行放大。加速度计和陀螺仪信号经放大,分别由angle 引脚和gyro 引脚输出后,信号通过AD 采样转换为数字信号,传递到微控制器中,再利用互补滤波算法,得到姿态角度。
惯性组合角度测量电路图
图1 惯性组合角度测量电路图
[page]
3 陀螺仪漂移和加速度传感器数据的预处理
 
MEMS 陀螺仪的漂移误差由常值漂移、随机漂移组成,漂移信号不符合平稳、正态、零均值的时间序列特征。图2 为陀螺仪采集到的一段数据, 对其积分后得到的俯仰角θ2,表现为误差不断累加,逐渐增大。通过式(4)所示算法进行均值扣除。
角速度与角度的曲线
图2 角速度与角度的曲线
 
去掉陀螺仪信号的均值(即常值分量)后,这样陀螺仪的漂移只含有随机漂移,此时的陀螺仪信号将作为互补滤波融合的输入。
 
加速度计受机体振动的影响,对其采用滑动均值滤波的方法对加速度传感器原始数据进行处理,滤波原理如式(5)所示:
滤波前后加速度计数据图
图3 滤波前后加速度计数据图
[page]
4 基于互补滤波器的姿态角度测量设计
 
陀螺仪动态响应特性优良,解算姿态角时,由于陀螺仪低频漂移的影响,积分后低频扰动会产生较大误差;加速度计解算的姿态角会受到平衡车运行中机体高频振动的影响, 输出角度中携带较大分量的高频干扰。二者在频域上具有互补特性,采用互补滤波器对这两种传感器数据融合,可提高姿态角度测量的精度和动态响应的性能。
 
互补滤波器的基本原理图如图4 所示。
互补滤波器的原理图
图4 互补滤波器的原理图
 
其中θ 为实际的角度值,ω 为陀螺仪测量的角速度, 互补滤波算法后估计的角度值为互补滤波算法后估计的角度值, 加速度计测量中引入的高频噪声n1,陀螺仪测量中引入的低频噪声n2,用低通滤波器G1(s)消除加速度计中的高频噪声n1,用高通滤波器G2(s)消除陀螺仪中的低频噪声n2。两个滤波器的传递函数, 被设计为(6)、(7)所示,图4 结构可化简为图5 结构。
互补滤波器频域图
图5 互补滤波器频域图
 
选用的滤波传递函数需满足G1(s)+G2(s)=1,由加速度计得到θ1经低通滤波器和陀螺仪得到θ2经高通滤波器后的数据融合为角度估计值互补滤波算法后估计的角度值,适当的选取权重因子K 值,可以使系统中高、低通滤波器具有合适的截止率。得到稳定的姿态角度。
教你用互补滤波算法测量两轮平衡车的姿态角度
由(8)式可看出,在小于截止频率的低频段,加速度计对姿态解算结果起主要作用;在大于截止频率的高频段,陀螺仪对姿态解算结果起主要作用。通过调整时间常数,改变滤波器的截止频率τ,实现对陀螺仪和加速度计权重的调整。
[page]
5 实验验证
 
为了验证上述设计方案的可行性, 利用直立两轮小车为实验验证平台。本实验使用惯性测量组合元件(IMU)中的惯性传感器分别选用了ENC-03(测量范围:±300(deg/s))陀螺仪,采样频率为1.25 kHz 和MMA7361 加速度计(测量范围:±1.5 g)。角度更新频率为1.25 kHz。互补滤波器截止频率为138 Hz。以俯仰角(θ)为例,进行了测试。
 
5.1 角速度和角度用互补滤波算法融合的分析
 
把陀螺仪测得的角速度数据和加速度计测得的角度数据通过(10)式进行融合后的波形如图6 所示,从图6 中可以看出, 经互补滤波算法融合后得到角度消除了陀螺仪的漂移和加速度计的高频扰动,可得以下结论:
 
1)单从陀螺仪获取的角速度积分后得到的角度是不正确的, 要把加速度计测得的角度值和陀螺仪测得角速度积分后的角度进行互补滤波算法融合,提高角度精度。
 
2)经互补滤波后陀螺仪的随机漂移得到较为明显的抑制,表现出了此互补滤波算法的有效性和优越性。
角速度与角度的融合曲线图
图6 角速度与角度的融合曲线图
 
5.2 经互补滤波处理后的角度与没有经处理后的角度比较分析
 
经互补滤波处理后的角度与直接由加速度计测得的角度时域比较,对其互补滤波处理前后的信号进行FFT 变换其频谱图如图7 所示, 通过互补滤波算法可以降低随机噪声的干扰,可以使测得角度的波形更加的平滑。
 融合前后角度比较图
图7 融合前后角度比较图
 
6 结论
 
文中分析了两轮平衡车姿态角度解算时陀螺仪漂移和加速度计高频扰动的影响,针对陀螺仪漂移和加速度计高频扰动采用互补滤波融合加速度计和陀螺仪信号。互补滤波能有效消除陀螺仪的漂移,抑制加速度计的高频扰动,减少输出姿态角的动态误差,提高了角度测量精度,能够满足两轮平衡车的姿态控制需要。实验结果表明了该方法的有效性,可推广应用于车载导航、两轮平衡车、微小型机器人的姿态角度测量系统。
 
要采购滤波器么,点这里了解一下价格!

为您推荐

贸泽开售 Sensirion 全系环境传感器,覆盖 CO₂、甲醛、颗粒物与制冷剂检测 新品速递

贸泽开售 Sensirion 全系环境传感器,覆盖 CO₂、甲醛、颗粒物与制冷剂检测

贸泽电子新增 Sensirion 授权环境传感器现货,双方自 2014 年持续合作,为工程师提供室内空气质量监测元器件。本次上线产品包含多款不同定位方案:SGD4x 面向 HVACR,用于 A2L 制冷剂泄漏检测;SFA40 专攻甲醛监测,体积小巧便于装进空气净化器;超小型 STCC4 可直测 CO₂,适合紧凑消费设备甚至睡眠监测穿戴产品;SEN6x 集成颗粒物、温湿度、VOC、NOx、CO₂或甲醛多参数,降低整机集成难度。贸泽提供原厂正品、可追溯货源,配套丰富设计资源,助力项目快速开发。

医疗穿戴 传感技术 测试测量 传感器 Sensirion(瑞士盛思锐)

贸泽开售 Sensirion 多款环境传感器,覆盖 HVACR、室内空气质量多场景监测 业界新闻

贸泽开售 Sensirion 多款环境传感器,覆盖 HVACR、室内空气质量多场景监测

室内空气质量监测需要兼顾多指标检测、体积、功耗与精度平衡,一直是硬件设计里的难点。贸泽电子现已上架 Sensirion 多款授权环境传感器产品,双方自 2014 年起长期合作,持续为工程师提供空气质量监测元器件方案。本次上新包含面向 HVACR 制冷剂泄漏检测的 SGD4x、微型甲醛传感器 SFA40、超小封装直测 CO₂的 STCC4,以及集成多参数的 SEN6x 传感模组,覆盖暖通安全、空气净化器、可穿戴、消费电子等不同应用,帮助设计人员简化开发,加快产品落地。

医疗穿戴 传感技术 测试测量 传感器 Sensirion(瑞士盛思锐)

英飞凌推出 XENSIV™ TLx49012 自校准数字角度传感器,面向汽车与工业电机控制 新品速递

英飞凌推出 XENSIV™ TLx49012 自校准数字角度传感器,面向汽车与工业电机控制

英飞凌推出 XENSIV™ TLx49012 系列霍尔数字角度传感器,包含四款产品,面向汽车与工业领域高要求电机控制场景。伴随车载无刷直流电机渗透率提升、机器人产业持续扩张,高精度低延迟角度传感方案成为电机控制系统的关键。该传感器搭载系统自校准能力,无需客户自研校准算法与外接参考编码器,支持轴向与非轴向安装,角度误差小于 0.1°,时延低至 1.5µs,提供多类输出接口;车规版本满足 ISO 26262 ASIL B 功能安全标准,适配汽车、工业自动化等不同电机平台,汽车版 TLE49012 与工业版 TLI49012 现已供货。

汽车电子 传感技术 测试测量 传感器 Infineon(英飞凌)

TDK PositionSense™九轴 MEMS 传感器,赋能物理 AI 设备智能感知 新品速递

TDK PositionSense™九轴 MEMS 传感器,赋能物理 AI 设备智能感知

TDK公司(TSE:6762)宣布其InvenSense PositionSense™已全球分销——这是一款双芯片九轴传感器解决方案,能够实现下一代定位精度和导航,应用于可穿戴设备、机器人、无人机、移动设备等领域。 PositionSense解决方案集成了TDK最低功耗的6轴IMU和基于TMR的3轴磁力计与片上传感器融合和校准软件,实现快速、准确的方向追踪和位置检测。

医疗穿戴 传感技术 测试测量 传感器 TDK

意法半导体发布基于 ST 可持续技术框架的先进情境感知传感器 业界新闻

意法半导体发布基于 ST 可持续技术框架的先进情境感知传感器

意法半导体推出两款全新六轴惯性测量单元 IMU,纳入 ST 可持续技术框架,兼顾高精度情境感知与环保材料规范。分为消费级 LSM6DSK320X 和工业级 ISM6HGK256X,依托超对称陀螺仪架构,可精准还原运动事件,适用智能穿戴、资产监测、机器人以及无人机测绘、飞控等场景,配套开发转接板后续也将陆续上市。

医疗穿戴 传感技术 测试测量 传感器 ST(意法半导体)

特别推荐

更多

行业动态

更多

技术应用

更多

选型替代

更多

产品信息

更多

热门搜索

更多

欢迎登录

没有账号,

账号注册

注册成功!

3S后自动为你跳转登陆