三轴地磁方位角原理及代码实现

2024-03-13 22:30

本文主要是介绍三轴地磁方位角原理及代码实现,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

开发平台:Arduino
控制板:Mbsbot-Mega2560版本
姿态传感器:GY85九轴模块

实现目标: 通过地磁计模块获取姿态角,位移量,估算当前相对位移

1.获取地磁计方位角

库函数获取地磁计原始数据

  float* magScaled = sen10724.readMagScaled();max_x = max(magScaled[0], max_x);min_x = min(magScaled[0], min_x);max_y = max(magScaled[1], max_y);min_y = min(magScaled[1], min_y);

这里使用库函数获取到三轴磁力计原始数据,每次采样都保存最大值和最小值,

  mag_angle_x = line_remap(magScaled[0], min_x, max_x, -1, 1);mag_angle_y = line_remap(magScaled[1], min_y, max_y, -1, 1);      //将磁偏角映射到-1~1

将磁偏角映射到单位圆中,转换为实际方位角

获取的方位角为0-360度,在越过0点的时候会有一个跳变的数据,会影响到实际的方位角

在这里插入图片描述

这里通过获取偏差进行输入补偿,得到的波形已经可以反映当前方位角的信息了

      if(abs(mag_angle - mag_last)  > max){mag_zero_bias = mag_angle - mag_last;}else{mag_zero_bias = 0;}if(mag_zero_bias != 0){mag_Bias += mag_zero_bias;  //获取偏移}Bias_value = mag_angle - mag_Bias;mag_last = mag_angle;

抑制零点跃迁
使用一阶低通滤波器优化后得到的方位角更加稳定

float Lowpass_filter(float Value)
{static int Last_val;int Save_val;Save_val = Value;Value *= 0.7;Value += Last_val * 0.3;Last_val = Save_val;return Value;
}

有了前面的方位角信息,接下来通过加速度计获取到里程就可以估算出一次运动的实际位移矢量了。

这篇关于三轴地磁方位角原理及代码实现的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/806393

相关文章

SpringBoot集成redisson实现延时队列教程

《SpringBoot集成redisson实现延时队列教程》文章介绍了使用Redisson实现延迟队列的完整步骤,包括依赖导入、Redis配置、工具类封装、业务枚举定义、执行器实现、Bean创建、消费... 目录1、先给项目导入Redisson依赖2、配置redis3、创建 RedissonConfig 配

Python的Darts库实现时间序列预测

《Python的Darts库实现时间序列预测》Darts一个集统计、机器学习与深度学习模型于一体的Python时间序列预测库,本文主要介绍了Python的Darts库实现时间序列预测,感兴趣的可以了解... 目录目录一、什么是 Darts?二、安装与基本配置安装 Darts导入基础模块三、时间序列数据结构与

Python使用FastAPI实现大文件分片上传与断点续传功能

《Python使用FastAPI实现大文件分片上传与断点续传功能》大文件直传常遇到超时、网络抖动失败、失败后只能重传的问题,分片上传+断点续传可以把大文件拆成若干小块逐个上传,并在中断后从已完成分片继... 目录一、接口设计二、服务端实现(FastAPI)2.1 运行环境2.2 目录结构建议2.3 serv

C#实现千万数据秒级导入的代码

《C#实现千万数据秒级导入的代码》在实际开发中excel导入很常见,现代社会中很容易遇到大数据处理业务,所以本文我就给大家分享一下千万数据秒级导入怎么实现,文中有详细的代码示例供大家参考,需要的朋友可... 目录前言一、数据存储二、处理逻辑优化前代码处理逻辑优化后的代码总结前言在实际开发中excel导入很

SpringBoot+RustFS 实现文件切片极速上传的实例代码

《SpringBoot+RustFS实现文件切片极速上传的实例代码》本文介绍利用SpringBoot和RustFS构建高性能文件切片上传系统,实现大文件秒传、断点续传和分片上传等功能,具有一定的参考... 目录一、为什么选择 RustFS + SpringBoot?二、环境准备与部署2.1 安装 RustF

Nginx部署HTTP/3的实现步骤

《Nginx部署HTTP/3的实现步骤》本文介绍了在Nginx中部署HTTP/3的详细步骤,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有一定的参考学习价值,需要的朋友们下面随着小编来一起学... 目录前提条件第一步:安装必要的依赖库第二步:获取并构建 BoringSSL第三步:获取 Nginx

MyBatis Plus实现时间字段自动填充的完整方案

《MyBatisPlus实现时间字段自动填充的完整方案》在日常开发中,我们经常需要记录数据的创建时间和更新时间,传统的做法是在每次插入或更新操作时手动设置这些时间字段,这种方式不仅繁琐,还容易遗漏,... 目录前言解决目标技术栈实现步骤1. 实体类注解配置2. 创建元数据处理器3. 服务层代码优化填充机制详

Python实现Excel批量样式修改器(附完整代码)

《Python实现Excel批量样式修改器(附完整代码)》这篇文章主要为大家详细介绍了如何使用Python实现一个Excel批量样式修改器,文中的示例代码讲解详细,感兴趣的小伙伴可以跟随小编一起学习一... 目录前言功能特性核心功能界面特性系统要求安装说明使用指南基本操作流程高级功能技术实现核心技术栈关键函

Java实现字节字符转bcd编码

《Java实现字节字符转bcd编码》BCD是一种将十进制数字编码为二进制的表示方式,常用于数字显示和存储,本文将介绍如何在Java中实现字节字符转BCD码的过程,需要的小伙伴可以了解下... 目录前言BCD码是什么Java实现字节转bcd编码方法补充总结前言BCD码(Binary-Coded Decima

SpringBoot全局域名替换的实现

《SpringBoot全局域名替换的实现》本文主要介绍了SpringBoot全局域名替换的实现,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有一定的参考学习价值,需要的朋友们下面随着小编来一... 目录 项目结构⚙️ 配置文件application.yml️ 配置类AppProperties.Ja