使用MPU6050计算方向盘角度

2023-10-09 02:50

本文主要是介绍使用MPU6050计算方向盘角度,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

我给你们作了榜样、叫你们照着我向你们所作的去作。

——【约翰福音13:15】

1.前言

前段时间接到一个项目需求:使用现有的陀螺仪MPU6050实现计算当前车辆的方向盘角度。

2.需求分析

MPU6050可获取三轴角速度和三轴加速度,并通过算法可以获得横滚角、俯仰角、航向角。

方向盘角度旋转会同步引起车轮的角度变化,方向盘旋转角度与车轮角度是一个已知量,可从实际车辆设计中获得,本次需求的车辆中方向盘旋转角度与前车轮的角度关系为:

左转时,方向盘角度范围 0~610°,车轮角度0~28°;

右转时,方向盘角度范围0~720°,车轮角度0~37°。

车辆在行驶时,若方向盘有角度,则一定在某个圆上绕圈,通过查找资料发现,其实每一个轮胎都在各自的圆上绕圈,并且最关键的是 这些圆的圆心在同一个点上,如下图(网上找的):

 按照上图,我们尝试分析,车辆在行驶过程中左转的转弯角度;左前轮和左后轮并圆心组成一个直角三角形,并且很容易看出,转弯角度(左前轮与前进方向的夹角)就是圆心角。

3.相关公式

根据上面的分析,我们可以从角度这个关键点去列出所有相关公式:

  1. A =  610°/28°     //!<方向盘角度与车轮角度的关系,左转比例因子A
  2. S = V * t             //!<圆弧长S = 车速V * 时间t
  3. L = 2π * r           //!<圆周长L = 2π * 半径r
  4. D = |d|                //!<角速度D = 角速度初始值d的绝对值
  5. α = D * t             //!<转弯角度α = 角速度D *时间t
  6. α/360° = S/L      //!<转弯角度α / 圆周角度360° = 圆弧长S / 圆周长L
  7. B/r = sinθ          //!<轴距B / 半径r = sin(车轮角度θ)
  8. P = A *θ             //!<方向盘旋转角度P = 比例因子A * 车轮角度θ

所以 左转时,P = A * arcsin(2π*|d|*B/(V*360°))

同样右转时也可以列出公式,所以要求方向盘角度需要的输入参数为:

比例因子A、角速度D、轴距B、车速V

其中比例因子A为实际车辆的固定值,角速度D可以从MPU6050中获取,轴距B就是车前轮圆心和车后轮圆心的距离,也为实际车辆的固定值,车速V可以实时从整车CAN中获取。

最后使用算法实现以上公式,便可求出当前方向盘角度。

4.结论

将以上算法应用到实际车辆后,实际测试结果均可基本满足测量需求。不过也存在一个缺点,就是当车速为零时,无法计算当前方向盘角度。另外现在新生产的车辆一般都会安装带有角度测量的方向盘,所以以上解决方案可用在后装车辆上。

本篇博文仅作记录。

这篇关于使用MPU6050计算方向盘角度的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



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

相关文章

Python中注释使用方法举例详解

《Python中注释使用方法举例详解》在Python编程语言中注释是必不可少的一部分,它有助于提高代码的可读性和维护性,:本文主要介绍Python中注释使用方法的相关资料,需要的朋友可以参考下... 目录一、前言二、什么是注释?示例:三、单行注释语法:以 China编程# 开头,后面的内容为注释内容示例:示例:四

Go语言数据库编程GORM 的基本使用详解

《Go语言数据库编程GORM的基本使用详解》GORM是Go语言流行的ORM框架,封装database/sql,支持自动迁移、关联、事务等,提供CRUD、条件查询、钩子函数、日志等功能,简化数据库操作... 目录一、安装与初始化1. 安装 GORM 及数据库驱动2. 建立数据库连接二、定义模型结构体三、自动迁

ModelMapper基本使用和常见场景示例详解

《ModelMapper基本使用和常见场景示例详解》ModelMapper是Java对象映射库,支持自动映射、自定义规则、集合转换及高级配置(如匹配策略、转换器),可集成SpringBoot,减少样板... 目录1. 添加依赖2. 基本用法示例:简单对象映射3. 自定义映射规则4. 集合映射5. 高级配置匹

Spring 框架之Springfox使用详解

《Spring框架之Springfox使用详解》Springfox是Spring框架的API文档工具,集成Swagger规范,自动生成文档并支持多语言/版本,模块化设计便于扩展,但存在版本兼容性、性... 目录核心功能工作原理模块化设计使用示例注意事项优缺点优点缺点总结适用场景建议总结Springfox 是

嵌入式数据库SQLite 3配置使用讲解

《嵌入式数据库SQLite3配置使用讲解》本文强调嵌入式项目中SQLite3数据库的重要性,因其零配置、轻量级、跨平台及事务处理特性,可保障数据溯源与责任明确,详细讲解安装配置、基础语法及SQLit... 目录0、惨痛教训1、SQLite3环境配置(1)、下载安装SQLite库(2)、解压下载的文件(3)、

使用Python绘制3D堆叠条形图全解析

《使用Python绘制3D堆叠条形图全解析》在数据可视化的工具箱里,3D图表总能带来眼前一亮的效果,本文就来和大家聊聊如何使用Python实现绘制3D堆叠条形图,感兴趣的小伙伴可以了解下... 目录为什么选择 3D 堆叠条形图代码实现:从数据到 3D 世界的搭建核心代码逐行解析细节优化应用场景:3D 堆叠图

Springboot如何正确使用AOP问题

《Springboot如何正确使用AOP问题》:本文主要介绍Springboot如何正确使用AOP问题,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录​一、AOP概念二、切点表达式​execution表达式案例三、AOP通知四、springboot中使用AOP导出

Navicat数据表的数据添加,删除及使用sql完成数据的添加过程

《Navicat数据表的数据添加,删除及使用sql完成数据的添加过程》:本文主要介绍Navicat数据表的数据添加,删除及使用sql完成数据的添加过程,具有很好的参考价值,希望对大家有所帮助,如有... 目录Navicat数据表数据添加,删除及使用sql完成数据添加选中操作的表则出现如下界面,查看左下角从左

python 常见数学公式函数使用详解(最新推荐)

《python常见数学公式函数使用详解(最新推荐)》文章介绍了Python的数学计算工具,涵盖内置函数、math/cmath标准库及numpy/scipy/sympy第三方库,支持从基础算术到复杂数... 目录python 数学公式与函数大全1. 基本数学运算1.1 算术运算1.2 分数与小数2. 数学函数

python中Hash使用场景分析

《python中Hash使用场景分析》Python的hash()函数用于获取对象哈希值,常用于字典和集合,不可变类型可哈希,可变类型不可,常见算法包括除法、乘法、平方取中和随机数哈希,各有优缺点,需根... 目录python中的 Hash除法哈希算法乘法哈希算法平方取中法随机数哈希算法小结在Python中,