《电子技术应用》
您所在的位置:首页 > 模拟设计 > 设计应用 > 基于DSP的实时姿态感知系统设计
基于DSP的实时姿态感知系统设计
电子技术应用
赵雨婷,邢计元,张东钥,任畅
中国电子信息产业集团有限公司第六研究所
摘要: 提出一种基于TMS320F28375S数字信号处理器(DSP)的高精度实时姿态测量系统,通过融合三轴磁通门传感器与微机电系统(MEMS)加速度计的六轴惯性数据,结合自适应卡尔曼滤波算法,实现俯仰角±0.1 °、航向角±0.5°的高精度测量。系统采用Δ-Σ型模数转换器(ADS131M04)实现128 kSPS同步采样率,并利用DSP内置的三角函数加速单元(TMU)将姿态解算周期压缩至0.8 ms。实验结果表明,在模拟动态干扰环境下,系统姿态更新率达1kHz,功耗低于1.5 W,显著优于传统方案,满足无人机、自动导引车(AGV)等移动平台的实时控制需求。
中图分类号:TP274 文献标志码:A DOI: 10.16157/j.issn.0258-7998.256763
中文引用格式: 赵雨婷,邢计元,张东钥,等. 基于DSP的实时姿态感知系统设计[J]. 电子技术应用,2025,51(11):76-82.
英文引用格式: Zhao Yuting,Xing Jiyuan,Zhang Dongyao,et al. Design of real-time attitude sensing system based on DSP[J]. Application of Electronic Technique,2025,51(11):76-82.
Design of real-time attitude sensing system based on DSP
Zhao Yuting,Xing Jiyuan,Zhang Dongyao,Ren Chang
The Sixth Research Institute of China Electronics Corporation
Abstract: This paper proposes a high-precision real-time attitude measurement system based on the TMS320F28375S Digital Signal Processor (DSP). By fusing six-axis inertial data from a triaxial fluxgate sensor and Micro-Electro-Mechanical System (MEMS) accelerometer with an adaptive Kalman filtering algorithm, the system achieves high-precision measurement with ±0.1° pitch angle and ±0.5° yaw angle accuracy. The system employs a Δ-Σ analog-to-digital converter (ADS131M04) to achieve 128 kSPS synchronous sampling rate, while utilizing the DSP's built-in Trigonometric Math Unit (TMU) to reduce the attitude calculation cycle to 0.8 ms. Experimental results demonstrate that under simulated dynamic interference conditions, the system attains a 1 kHz attitude update rate with power consumption below 1.5 W, significantly outperforming conventional solutions. The system meets the real-time control requirements for mobile platforms such as Unmanned Aerial Vehicles (UAVs) and Automated Guided Vehicles (AGVs).
Key words : attitude measurement;DSP;sensor fusion;Kalman filter;real-time system

引言

在自主移动机器人、无人机及智能运载工具领域,精准的姿态感知是实现稳定导航与控制的核心前提。然而,传统姿态测量系统面临显著技术挑战:一方面,低成本MEMS陀螺仪虽具备高动态响应特性,但其输出易受温度漂移和积分误差影响,导致长期稳定性不足;另一方面,单一加速度计无法有效区分重力加速度与载体运动加速度,在复杂运动场景下误差显著;此外,磁通门传感器虽能提供绝对航向信息,但易受电机、电源线等电磁干扰,导致航向角漂移。针对上述问题,本研究提出一种硬件-算法协同优化的解决方案。硬件层面以TMS320F28375S型DSP为核心,集成浮点运算单元(FPU)与三角函数加速单元(TMU),配合双通道24位Δ-Σ ADC(ADS131M04)实现磁通门与加速度计信号的同步高精度采样;算法层面设计改进型扩展卡尔曼滤波(EKF)融合六轴惯性数据,引入基于椭球拟合的硬磁干扰在线补偿机制,并通过直接内存访问(DMA)优化数据传输效率[1-3]。

现有姿态感知系统多采用单一传感器或简单融合算法,难以满足复杂环境下的高精度需求。例如,基于四元数的互补滤波算法虽计算量小,但动态响应不足;传统卡尔曼滤波对非线性系统建模能力有限。近年来,研究者开始探索多传感器融合方案,如Mahony滤波器和Madgwick算法通过梯度下降法优化姿态估计,但依赖手动调参且抗磁干扰能力弱;部分研究采用FPGA并行计算姿态解算,但功耗与成本较高;部分研究提出基于神经网络的地磁补偿算法,但实时性不足[4-6]。本研究通过结合高性能DSP的硬件特性与自适应滤波算法,在精度、实时性与功耗之间取得平衡。


本文详细内容请下载:

https://www.chinaaet.com/resource/share/2000006844


作者信息:

赵雨婷,邢计元,张东钥,任畅

(中国电子信息产业集团有限公司第六研究所,北京 100083)


官方订阅.jpg

此内容为AET网站原创,未经授权禁止转载。