一种基于六轴传感器设备安装姿态校准方法与流程

文档序号:17687141发布日期:2019-05-17 20:43阅读:992来源:国知局

本发明涉及汽车技术领域,具体地说,涉及一种基于六轴传感器设备安装姿态校准方法。



背景技术:

随着科技的发展,汽车作为人们出行的交通工具之一,其普及度越来越高。汽车的各种配置也越来越丰富,现有的很多车主爱好加装各种汽车辅助系统来提高驾驶的乐趣和安全性,比如,现在加装汽车行驶行为判断系统,这种系统一般是基于lsm6ds33六轴传感器,以高通mdm9x07为主控芯片的系统,它通过汽车obd口安装在车上的,但不同品牌的车,obd口位置和朝向不一样,安装十分麻烦,所以需要安装姿态自动校准来解决上述问题。



技术实现要素:

本发明的内容是提供一种基于六轴传感器设备安装姿态校准方法,其能够克服现有技术的某种或某些缺陷。

根据本发明的一种基于六轴传感器设备安装姿态校准方法,其包括以下步骤:

一、打开传感器读取数据;

二、静态校验,校准设备安装在汽车上位置;汽车停在水平的路面上,采集当前加速计数据得出设备安装姿态与汽车xyz轴的转换方法,把设备的xyz轴数据换算到汽车水平坐标上,找出重力轴;

三、动态校验,判断出汽车行驶方向与xyz轴方向关系;过滤汽车倒车的动作,采集陀螺仪和加速计的数据,同时保证汽车一定车速,得出汽车行驶方向和xyz轴方向关系;

四、经过校验之后,得出汽车急加速,急减速,急转弯等行驶动作。

作为优选,步骤二中,找出重力轴的判断方法为:如果xyz三个轴中哪个轴读取的数据接近1g,这个轴就是重力轴,其他两个轴就在水平面上,另外两个轴与汽车参考坐标通过汽车正向行驶得出。

作为优选,步骤二中,如果找不出重力轴,那么设备是经过旋转后安装,通过读取数据,找出旋转轴,旋转轴数据接近0,通过坐标转换,得出设备坐标与汽车坐标关系。

作为优选,坐标转换是列矩阵在某一参考坐标系的投影通过方向余玄矩阵转换到另一个坐标系上过程。

作为优选,步骤三中,先通过读取汽车rpm或gps的速度,当汽车行驶大于20km/h,连续采集100组加速计和陀螺仪的数据,陀螺仪数据保证汽车直线行驶,通过加速计x和y轴数据来判断,哪个是汽车行驶方向轴,轴的方向与汽车行正向关系。

本发明提供了一种基于六轴传感器设备安装姿态校准方法,能够较佳地姿态校准,使得不同车型的汽车均能方便的安装汽车行驶行为判断系统。

具体实施方式

为进一步了解本发明的内容,结合实施例对本发明作详细描述。应当理解的是,实施例仅仅是对本发明进行解释而并非限定。

实施例1

本实施例提供了一种基于六轴传感器设备安装姿态校准方法,其包括以下步骤:

一、打开传感器读取数据;

二、静态校验,校准设备安装在汽车上位置;汽车停在水平的路面上,采集当前加速计数据得出设备安装姿态与汽车xyz轴的转换方法,把设备的xyz轴数据换算到汽车水平坐标上,找出重力轴;

三、动态校验,判断出汽车行驶方向与xyz轴方向关系;过滤汽车倒车的动作,采集陀螺仪和加速计的数据,同时保证汽车一定车速,得出汽车行驶方向和xyz轴方向关系;

四、经过校验之后,得出汽车急加速,急减速,急转弯等行驶动作。

本实施例中,步骤二中,设备安装到车内,不一定是z轴与水平面垂直,也有可能是x轴或y轴,找出重力轴的判断方法为:如果xyz三个轴中哪个轴读取的数据接近1g,这个轴就是重力轴,其他两个轴就在水平面上,另外两个轴与汽车参考坐标通过汽车正向行驶得出。

本实施例中,步骤二中,如果找不出重力轴,那么设备是经过旋转后安装,通过读取数据,找出旋转轴,旋转轴数据接近0,通过坐标转换,得出设备坐标与汽车坐标关系。

本实施例中,坐标转换是列矩阵在某一参考坐标系的投影通过方向余玄矩阵转换到另一个坐标系上的过程。比如:

r1=cr2;

其中,c为将一个列矩阵从载体坐标系2转换到汽车水平坐标系1的方向余玄矩阵。

若绕z转动角度β,余玄方向矩阵c可以得到:

则得到:

r1={x2cosβ-y2sinβ,x2sinβ+y2cosβ,z2};

因汽车是停止在水平面上,则此时r1={0,0,g},r2通过传感器数据读到,可以解出cosβ和sinβ,同时得到余玄方向矩阵c;

若绕其他轴转动也类似计算。

本实施例中,步骤三中,通过前面两步已经知道设备坐标系和汽车坐标系关系,但是还一个就是坐标转换后方向与行驶方向不一定是一致的,所以要在汽车正常行驶来判断。先通过读取汽车rpm或gps的速度,当汽车行驶大于20km/h,连续采集100组加速计和陀螺仪的数据,陀螺仪数据保证汽车直线行驶,通过加速计x和y轴数据来判断,哪个是汽车行驶方向轴,轴的方向与汽车行正向关系。

经过静态校验和动态校验就可以得出设备安装姿态,求出余玄方向矩阵,把传感器数据传送汽车坐标系上,就可以算出汽车行驶状态。以上示意性的对本发明及其实施方式进行了描述,该描述没有限制性。所以,如果本领域的普通技术人员受其启示,在不脱离本发明创造宗旨的情况下,不经创造性的设计出与该技术方案相似的结构方式及实施例,均应属于本发明的保护范围。



技术特征:

技术总结
本发明涉及汽车技术领域,涉及一种基于六轴传感器设备安装姿态校准方法,其包括以下步骤:一、打开传感器读取数据;二、静态校验,车停在水平路面的上,采集当前加速计数据得出设备安装姿态与汽车XYZ轴的转换方法,把设备的XYZ轴数据换算到汽车水平坐标上,找出重力轴;三、动态校验,判断出汽车行驶方向与XYZ轴方向关系;过滤汽车倒车的动作,采集陀螺仪和加速计的数据,同时保证汽车一定车速,得出汽车行驶方向和XYZ轴方向关系;四、经过校验之后,得出汽车急加速,急减速,急转弯等行驶动作。本发明使得不同车型的汽车均能方便的安装汽车行驶行为判断系统。

技术研发人员:唐宗欢;陈元辰;杨纯文;吴学伟
受保护的技术使用者:深圳市伟文无线通讯技术有限公司
技术研发日:2019.02.28
技术公布日:2019.05.17
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1