CN105823484A - 一种集成式惯性导航测量单元及相应测量方法 - Google Patents

一种集成式惯性导航测量单元及相应测量方法 Download PDF

Info

Publication number
CN105823484A
CN105823484A CN201610355456.9A CN201610355456A CN105823484A CN 105823484 A CN105823484 A CN 105823484A CN 201610355456 A CN201610355456 A CN 201610355456A CN 105823484 A CN105823484 A CN 105823484A
Authority
CN
China
Prior art keywords
module
measuring unit
chip
acceleration
inertial navigation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201610355456.9A
Other languages
English (en)
Other versions
CN105823484B (zh
Inventor
李亮
张晓宏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tsinghua University
Original Assignee
Tsinghua University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tsinghua University filed Critical Tsinghua University
Priority to CN201610355456.9A priority Critical patent/CN105823484B/zh
Publication of CN105823484A publication Critical patent/CN105823484A/zh
Application granted granted Critical
Publication of CN105823484B publication Critical patent/CN105823484B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种集成式惯性导航测量单元及相应测量方法,所述集成式惯性导航测量单元包括:印制电路板、频率选择模块、VN‑200芯片、组合传感器、三轴加速度计模块、电源稳压模块、内部电源、电源转换模块以及单片机模块。VectorNav‑200输出GPS信号,X、Y、Z三个方向的加速度和旋转角速度。组合传感器输出横摆角速度和侧向加速度;三轴加速度计输出X,Y,Z三个方向的加速度。单片机模块将上述信号统一转换为CAN信号。测量单元中设有互检自检和补偿机制;并且可由所测得的车辆的纵向加速度计算出当前道路坡度;单片机模块中编程有插值算法,可由用户设定CAN信号的输出频率,实现与整车的通信。本发明精度高、集成度高、稳定性好、适用范围广、数据可靠。

Description

一种集成式惯性导航测量单元及相应测量方法
技术领域
本发明涉及一种集成式惯性导航测量单元及相应测量方法,属于电路技术和信号处理领域。
背景技术
随着信息科技的高速发展,现代汽车日益强调智能化、网联化和节能化。面对车内外严峻的使用环境,为满足时代要求,汽车需装载庞大和复杂的汽车电子系统。车载测量设备作为车辆电控系统的主要控制依据,装置集成度的高低以及数据的稳定性和可靠性极为重要。整车运动姿态(包括侧倾角及角速度,俯仰角及角速度,横摆角及角速度)、X、Y、Z三个方向加速度这些惯性参数和GPS位置信号是车辆主动安全和智能交通控制的核心参量。与此同时,若汽车能够根据当前道路坡度主动调节发动机动力输出并变更变速箱档位,那么对于汽车的节能减排意义重大。
传统的惯性测量和GPS定位依旧分离开来,没有形成集成式设计,并且采用单串行方案,缺乏校验机制,单个部件的损坏将影响整个装置的正常工作。而传统的坡度识别方法主要有条式水平仪和倾角仪两种,前者尺寸较大,测量范围小;后者不能实现加速情况下的测量,应用受限。
中国发明专利CN201410635870.6公开了一种基于FPGA的微小惯性测量单元。由三轴MEMS加速度计模块和陀螺仪模块分别感知X、Y、Z三个轴向的加速度和角速度;温度传感器感知载体周围的环境温度;信号处理器将采集到的信号转换成符合RS232协议的格式发送出去。该发明由于以FPGA芯片作为系统信号处理器,减少了运行周期和硬件误差并有利于实现系统小型化。但测量设备一旦出错无法自行纠正,将会给用户带来错误信息,而且,其也无法提供GPS信息。
中国发明专利CN201410817721.1公开了一种车载惯性导航系统,包括数据采集模块和车载终端。数据采集模块包括角速度传感器、加速度计和轮胎转速差传感器,三者通过数据线连接USB口。该发明可通过车辆的角速度、加速度、轮胎转速差和一系列计算,有效解决卫星失效时,车辆无法定位的情况。但由于包含车载终端,价格昂贵,系统复杂,集成度不高。
发明内容
针对上述问题,本发明希望提供一种精度高,稳定性好,可靠性高的集成式惯性导航测量单元及相应测量方法。本发明希望该测量单元为用户提供更准确的检测信息,并且一旦系统中即便个别测量数据出错,也能输出正确的结果,即便某个测量部件出错,能够快速准确地判断出出错部件并进行相应补偿。
为了实现上述技术目的,本发明采用如下技术方案:
一种集成式惯性导航测量单元,其特征在于,所述集成式惯性导航测量单元包括:印制电路板、频率选择模块、VN-200芯片、组合传感器、三轴加速度计模块、电源稳压模块、内部电源、电源转换模块以及单片机模块,
其中,所述VN-200芯片和组合传感器分别安装在所述印制电路板上;
所述频率选择模块用于基于用户控制进行通信频率选择;
所述VN-200芯片用于测量所述集成式惯性导航测量单元所安装位置的GPS定位、横摆角速度、侧向加速度以及X、Y、Z三个方向的加速度;
所述组合传感器用于测量所述集成式惯性导航测量单元所安装位置的横摆角速度和侧向加速度;
所述三轴加速度计模块用于测量所述集成式惯性导航测量单元所安装位置的X、Y、Z三个方向的加速度;
所述内部电源用于通过电源稳压模块和电源转换模块为测量单元供电;
所述单片机模块用于对所测得信号进行检测和补偿。
优选地,所述集成式惯性导航测量单元还包括:第一压线端子、第二压线端子、RS-232串口驱动模块、连接器、按键开关、锂电池、接插件、CAN驱动模块、在线调试模块以及报警模块。
优选地,所述VN-200芯片、组合传感器、频率选择模块、CAN驱动模块、三轴加速度计模块、单片机模块、在线调试模块和报警模块彼此直接或间接电气相连;所述单片机模块接收并处理来自经RS-232串口驱动模块转换后的所述VN-200芯片的信号以及频率选择模块和三轴加速度计模块的信号;所述CAN驱动模块通过接插件和被测车辆的CAN网络相连。
另一方面,本发明提供一种利用所述的集成式惯性导航测量单元对车辆运动信息的进行测量的方法,其特征在于,所述方法包括:
步骤1、检测所述集成式惯性导航测量单元的上电信号,当检测到上电信号时,利用所述单片机模块采集所述内部电源的电压和所述VN-200芯片的头文件,当所述内部电源的电压低于预定阈值时发出报警信号,提示进行电源充电或切换至外部蓄电池;如果所述VN-200芯片的头文件符合预定要求则转至步骤2,否则发出报警信号;
步骤2、设置所述集成式惯性导航测量单元的CAN总线的信号输出频率;
步骤3、所述单片机模块分别接收来自所述VN-200芯片的ASCII码形式的信号、组合传感器的CAN信号和三轴加速度计模块的二进制码形式的信号,当所述单片机模块部分接收到或全部接收到上述三种信号时,产生相应中断,并在中断函数中将ASCII码接收标志位ASCII_flag赋1;否则,等待接收;
步骤4、当所述单片机模块确定ASCII_flag=1时,跳出中断,进入到所述VN-200芯片与所述组合传感器的CAN信号或所述三轴加速度计的二进制信号对应的ASCII码解析函数当中;
步骤5、根据接收到的ASCII码,查找美国标准信息交换代码表,得到对应的十进制数;根据所述组合传感器的CAN协议和三轴加速度计的二进制代码协议可得到对应的十进制数;
步骤6、将解析出来的ASCII码按位权加和,获得表征集成式惯性导航测量单元所测得参数的状态量;
步骤7、对从所述VN-200芯片测得的数据以及从所述组合传感器和三轴加速度计测得的数据进行坐标归一化;
步骤8、对从所述VN-200芯片测得的数据以及从所述组合传感器和三轴加速度计测得的数据进行互检校验以及自检校验,并根据步骤2设定的发送频率进行插值运算,最终以CAN信号的形式、按设定的频率输出校验后的测量数据。
优选地,所述步骤6包括:
步骤6.1、根据所述组合传感器测得的数据,解析出侧向加速度N_ay和横摆角速度N_yawRate;
步骤6.2、根据所述三轴加速度计测得的数据解析出来自所述三轴加速度计的纵向加速度F_ax、侧向加速度F_ay和垂向加速度F_az;
步骤6.3、根据VN-200芯片测得的数据解析出侧向加速度VN_ay、横摆角速度VN_yawRate、纵向加速度VN_ax和垂向加速度VN_az。
优选地,所述步骤8包括:
将来自所述组合传感器的侧向加速度N_ay、横摆角速度N_yawRate,来自所述三轴加速度计的纵向加速度F_ax、侧向加速度F_ay和垂向加速度F_az与来自所述VN-200芯片的侧向加速度VN_ay、横摆角速度VN_yawRate、纵向加速度VN_ax和垂向加速度VN_az分别作差。
在一种优选实现方式中,所述步骤8包括:
步骤8.1、分别判断来自组合传感器、三轴加速度计和VN-200芯片的相同参数的差值是否小于预定阈值;
步骤8.2、如果所述差值小于预定互差阈值,则进行数据输出;
步骤8.3、如果所述差值大于等于所述预定互差阈值,则相应的错误标志位自加1,连续校验三组,若三组互差值皆大于预定互差阈值,则判定相应参数测量出错;
步骤8.4、对出错参数所涉及的测量部件进行自检,所述自检包括将来自不同测量模块的出错参数的当前值与上一周期的历史值分别进行比对,求得对应参数的自差值,判定自差值是否小于自差阈值,如果所述自差值小于自差阈值,则判定相应测量模块运行正确,输出该测量模块的测量结果作为输出;若每个测量模块对应的自差值均大于其自差阈值,则判断出错信号类型,若为加速度,则利用GPS信号求差分补偿输出;若为加速度外的其它信号则报警并结束。
在一种优选实现方式中,所述方法还包括步骤9,所述步骤9包括:
步骤9.1、获取测量单元所安装车辆的车速信号,并构造fifo先进先出序列来存放车速历史数据V1,V2,……,Vn+1,其中,n为表示数据数目的整数;
步骤2、根据采集到的车速信号依次进行差分,并用fifo先进先出序列存储整车加速度a1,a2,……,an,然后采用中位值平均滤波法进行滤波;
步骤3、根据公式获得一系列坡度序列θ1,θ2,……,θn
步骤4、对步骤3所采集到的数据求平均值即可输出当前道路坡度。
所述步骤9.2包括:
步骤9.2.1、求fifo先进先出加速度队列a1-an中的最大值amax和最小值amin
步骤9.2.2、求得最新加速度值a0,计算ap就是平滑后的加速度值;
步骤9.2.3、fifo循环移位,an=an-1,an-1=an-2,……,a1=a0
步骤9.2.4、重复步骤9.2.1。
本发明由于采取以上技术方案,与现有测量单元相比,具有以下优点:
1、测量单元设有频率选择模块,用户可根据具体需求调节CAN数据的发送频率;
2、无需外接电源,设置电源稳压模块,承受电压范围宽,可同时适配不同车型,并且外围连接简单,安装灵活;
3、兼具惯性测量、GPS定位和道路坡度测量的功能,系统集成度高,可有效降低电子系统的复杂度;
4、数据测量更加稳定、准确、可靠,并且,一旦系统中某个测量数据出错,能够及时发现出错数据,并且输出正确数据;并且一旦某个部件测量出错能够准确地判断出出错部件并进行相应补偿以及报警。
附图说明
图1为本发明实施例中的集成式测量单元的框架图;
图2为集成式测量单元的惯性测量元件坐标系图;
图3为利用本发明的测量单元进行惯性导航测量的流程图;
图4为本发明的测量方法进行校验补偿的流程图;
图5为车辆在坡道行驶时受力图;
图6为加速度计算道路坡度流程图;
其中:1-印制电路板、2-压线端子、3-压线端子、4-M2.5螺栓、5-VectorNav-200(VN-200)、6-RS-232串口驱动模块、7-电源稳压模块,8-电源转换模块、9-连接器、10-按键开关、11-锂电池、12-接插件、13-频率选择模块、14-CAN驱动模块、15-三轴加速度计模块、16-单片机模块、17-在线调试模块、18-报警模块、19-组合传感器、20-M6.0螺栓。
具体实施方式
实施例1
下面将结合附图对本发明的实施例进行详细说明:
图1为本实施例中的集成式惯性导航测量单元及相应测量方法的整体框架图。如图所示,在本实施例中,测量单元包括印制电路板1、压线端子2、压线端子3、M2.5螺栓4、VectorNav-200(VN-200)5、RS-232串口驱动模块6、电源稳压模块7、电源转换模块8、连接器9、按键开关10、锂电池11、接插件12、频率选择模块13、CAN驱动模块14、三轴加速度计模块15、单片机模块16、在线调试模块17、报警模块18、组合传感器19、M6螺栓20。
其中,VectorNav-200(VN-200)5和组合传感器19分别通过M2.5螺栓4和M6螺栓20固定在印制电路板1上,三者为机械连接;VectorNav-200(VN-200)5和组合传感器19的供电线和信号线被压紧在压线端子2和压线端子3上,实现与其它模块的通信,三者为电气连接;锂电池11的电源线和地线和连接器9电气相连;连接器9与电源稳压模块7和电源转换模块8电气相连;电源稳压模块7与压线端子2电气相连;电源转换模块8与压线端子3、RS-232串口驱动模块6、频率选择模块13、CAN驱动模块14、三轴加速度计模块15、单片机模块16、在线调试模块17和报警模块18电气相连;接插件12和CAN驱动模块14电气相连;单片机模块16与压线端子2、压线端子3、RS-232串口驱动模块6、频率选择模块13、CAN驱动模块14、三轴加速度计模块15、在线调试模块17和报警模块18电气相连。
所述印制电路板1为本发明电路和电子元器件的承载实体;
所述压线端子2焊接在印制电路板1上,一端从左到右依次连接组合传感器19的地线,CANL线,CANH线和12V电源线,另一端与印制电路板1相对应的位置相连。实现组合传感器与印制电路板1的通信。
所述压线端子3也焊接在印制电路板1上,一端从左到右依次连接VectorNav-200(VN-200)5的供电线,RS232_T线,RS232_R线和地线,另一端与印制电路板1相对应的位置相连。实现VectorNav-200(VN-200)5与印制电路板1的通信。
所述M2.5螺栓4与VectorNav-200(VN-200)5的安装孔匹配,左右对称各一个,通过螺母将VectorNav-200(VN-200)5固连在印制电路板1上。
所述VectorNav-200(VN-200)5为美国VectorNav科技公司推出的高精度9轴传感器,同时集成GPS接收器。额定工作电压为5V。坐标系方向如图2所示。可输出运动物体在X,Y,Z三个方向的加速度、角速度、磁场强度和当前位置;输出数据类型为ASCII码。
所述RS-232串口驱动模块6包括MAX232ACSE和与引脚配合使用的0.1uF陶瓷电容,额定工作电压为5V。VectorNav-200(VN-200)5电平类型为RS-232电平,而单片机模块16所能处理的电平类型为TTL电平,RS-232串口驱动模块6负责进行电平类型的转换。
所述电源稳压模块7包括电源电压稳压芯片LM2940-12V和输入引脚的0.47uF陶瓷电容和输出引脚的22uF电解质电容,乘用车蓄电池电压为12V,商用车蓄电池电压为24V,为同时满足不同车型的需求,此模块可承受的输入电压范围为5V-26V,输出电压为12V,并且当锂电池电量不足或者外接蓄电池电量不足时,输出电压可被钳制在12V,保证集成式惯性导航测量单元在低电压时依旧可正常工作。
所述电源转换模块8包括电源电压转换芯片TLE4271-2G和外围的电容和电阻。乘用车蓄电池电压为12V,商用车蓄电池电压为24V。为满足不同车型的使用需求,此模块可承受的输入电压为6V-40V,输出电压为5V。实现为额定工作电压为5V模块的稳定供电。此外,TLE4271-2G提供抑制引脚INH以提供开关的功能,当此引脚为低电平时,不能转换电压,测量单元不工作;当引脚为高电平时,可正常转换电压,测量单元工作。
所述连接器9为2针的母头,可与锂电池的公头相配合,将电源引入到印制电路板1中。
所述按键开关10包括两个引脚,一端连接12V,一端连接上述电源电压转换芯片TLE4271-2G的INH引脚,按键开关按下时,测量单元开始工作;否则,测量单元退出工作。
所述锂电池11额定工作电压为12V,为测量单元供电。
所述接插件12自上至下信号依次为蓄电池的供电线,地线,CANH线和CANL线。
其中,供电线和地线用于保障信号的稳定。当锂电池的电压过低时,可连接车上的蓄电池使测量单元正常工作。测量单元测量和转换出来的CAN信号通过接插件12和整车的CAN网络相连。
所述频率选择模块13由旋钮开关和限流电阻组成。与单片机模块的模块转换引脚相连,共设置100HZ,200HZ,500HZ和1000HZ四个档位,可供用户根据需求选择。
所述CAN驱动模块14包括CAN驱动芯片TLE6250G和外围的电阻电容,接收来自单片机模块16经采集和处理后的信号并将其转换成CAN信号,通过CAN总线和CAN网络通信。
所述三轴加速度计模块15包括加速测量芯片FXAS21002和外围的电阻和电容。坐标系方向如图2所示。采用同步通信,可测量得到X,Y,Z三个方向的加速度。
所述单片机模块16采用Infineon16位单片机XC2765,包括滤波电路,复位电路和晶振电路,单片机模块16接收来自VectorNav-200(VN200)5,三轴加速度计模块15和组合传感器19的信号,并在软件中统一将信号类型转换为CAN信号。
所述在线调试模块17与英飞凌专用仿真器相连,进行程序的烧录和变量的在线观测与调试。
所述报警模块18设置发光二极管和蜂鸣器,和单片机的IO口相连,当检测到锂电池电压过低或者系统故障时可发出警告。
所述组合传感器19为两轴的惯性传感器,额定工作电压为12V,坐标系方向如图2所示。四个端口从左到右依次为地线GND,CANL,CANH,和供电线12V,可测得横摆加速度和侧向加速度,信号类型为CAN信号。
所述M6螺栓20和组合传感器19的安装孔适配,左右对称各一个,和螺母配合可将组合传感器固定在印制电路板1上。
为进一步说明本发明的信息交互,下面列表对集成式惯性导航测量单元及相应测量方法中的信号流加以说明:
参见表1,集成式惯性导航测量单元及相应测量方法信号流,其中包括器件名称、信号名称和信号类型。
表1集成式惯性导航测量单元及相应测量方法信号流
所述VectorNav-200(VN-200)5为主,三轴加速度计模块15和组合传感器19为辅,以达到相互校验和冗余设计的目的。
为进一步说明本发明专利的实施方式,将结合图2详细说明信号的解析和协议的制定方法:
步骤1、当按键开关按下检测到上电信号时,开始检测单片机所采集到的蓄电池电压和VN200的头文件,当蓄电池电压小于7V时红色指示灯开始闪烁,提示锂电池需要充电或切换至外部蓄电池;当VN200的头文件并非“$VNISL”时白色指示灯闪烁,当接收到正确的头文件时指示灯灭。否则程序开始正常运行;
步骤2、拨动旋钮开关,设置CAN信号的输出频率,当模数转换模块采集到相应的电压值时便会触发相应频率的CAN信号发送函数;
步骤3、当单片机接收到ASCII码时,产生中断,并在中断函数中将ASCII码接收标志位ASCII_flag赋1;否则,等待接收;
步骤4、当单片机检测到ASCII_flag=1时,程序跳出中断,转至ASCII码解析函数中运行。计数标志自加1,当计数标志位处于所需变量的字节范围时,将数值取出并保存在一维数组当中;否则,不取出数据,表2列出了所需数据的字节范围;由于字符串的总长度为164,因此当计数标志位大于164时,清零;
表2所需数据字节范围
步骤5、根据接收到的ASCII码,查找美国标准信息交换代码,可得到对应的十进制数,并用一维数组记录下来;
步骤6、串口数据是按照位发送的,因此需将解析出来的ASCII码按位权加和,可得到如表2所示的各种信号;
步骤7、如图2所示,VectorNav-200(VN200)坐标系的Y向和Z向与组合传感器和三轴加速度计的相反,为了方便相互校验和检测,需进行坐标的规一划。在程序中对侧向加速度VN_ay,垂向加速度VN_az,横摆角速度VN_yawRate取相反数即可;
步骤8、定义所得状态量的CAN协议,编写CAN发送函数,实现信号的采集和类型的转换;
为进一步说明本发明专利的互检、自检和补偿机制,将结合图3说明其设计流程:
步骤1、当检测到上电信号时,单片机模块检测其接收端口是否接收到来自组合传感器的CAN数据,是,继续运行;否,监测等待;与此同时,单片机也检测是否接收到来自三轴加速度计的信号,是,继续运行;否,监测等待;
步骤2、当接收到CAN数据后,产生中断,接收标志CAN_flag赋1;同理当串口接收到8位二进制数时,产生中断,接收标志Binary_flag赋1;
步骤3、检测到标志位变为1后,定义CAN解析函数,程序随即转入执行,根据组合传感器的CAN协议通过移位和位与操作,解析出侧向加速度N_ay和横摆角速度N_yawRate;同理,可解析出来自三轴加速度计的纵向加速度F_ax、侧向加速度F_ay和垂向加速度F_az;
步骤4、将来自组合传感器的N_ay、N_yawRate,来自三轴加速度计的纵向加速度F_ax、侧向加速度F_ay和垂向加速度F_az与来自VectorNav-200(VN200)的侧向加速度VN_ay、横摆角速度VN_yawRate、纵向加速度VN_ax、侧向加速度VN_ay和垂向加速度VN_az分别作差校验;
步骤5、根据步骤4所得的互差开始进行校验,编写校验函数,当差值小于所设定的最大的互差阈值,说明测量单元运行无误,数据输出;否则,相应的错误标志位自加1,连续校验三组,若Fault_flag大于所设的门限值,则判定测量单元有器件运行出错;
步骤6、当互检检测到有错误信号时,随即开启自检机制以确定具体错误位置。将两个相关信号的当前值和上一周期的历史数据作对比求得自差值。自差值若大于所设的自差阈值,则判定正确;否则,判定错误。若有一个出错,则输出正确的;若两个都出错,则判断出错信号类型,若为加速度,则通过GPS位置差分补偿输出加速度,若为其它,则报警结束;
步骤7、根据所设定的发送频率进行插值,最终将信号发送到整车CAN网络。
本发明的测量单元及相应测量方法还能够提供车辆行驶的坡度信息。
如图5所示,车辆在坡道上行驶时所受力包括:设车辆的总质量为m,道路坡度为θ。Ft-驱动力、Ff-摩擦力、Fn-道路支持力、G-整车重力、Gsinθ-车重沿坡道分量、Gcosθ-车重沿垂直坡道分量、acar-整车加速度。则车辆所受的平衡力方程如下:
ma c a r = F t - F f - G s i n θ m V N _ a x = F t - F f - - - ( 1 )
对上式整理可得:gsinθ=VN_ax-acar (2)
则道路坡度为:
其中g为重力加速度。
为进一步说明本发明专利的根据纵向加速度估算道路坡度的算法,将结合图6说明具体的计算过程:
步骤1、从整车CAN网络获取车速信号,并构造fifo先进先出序列来存放车速历史数据V1,V2,……,Vn+1,n为表示数据数目的整数;
步骤2、根据采集到的车速信号依次进行差分,并用fifo先进先出序列存储整车加速度a1,a2,……,an,然后采用中位值平均滤波法进行滤波;
步骤3、根据公式(3)可得到一系列坡度序列θ1,θ2,……,θn
步骤4、对步骤3所采集到的数据求平均值即可输出当前道路坡度。
所述步骤2包括:
步骤2.1、求fifo先进先出加速度队列a1-an中的最大值amax和最小值amin
步骤2.2、求得最新加速度值a0,计算ap就是平滑后的加速度值;
步骤2.3、fifo循环移位,an=an-1,an-1=an-2,……,a1=a0
步骤2.4、重复步骤2.1。
虽然上面结合本发明的优选实施例对本发明的原理进行了详细的描述,本领域技术人员应该理解,上述实施例仅仅是对本发明的示意性实现方式的解释,并非对本发明包含范围的限定。实施例中的细节并不构成对本发明范围的限制,在不背离本发明的精神和范围的情况下,任何基于本发明技术方案的等效变换、简单替换等显而易见的改变,均落在本发明保护范围之内。

Claims (6)

1.一种集成式惯性导航测量单元,其特征在于,所述集成式惯性导航测量单元包括:印制电路板、频率选择模块、VN-200芯片、组合传感器、三轴加速度计模块、电源稳压模块、内部电源、电源转换模块以及单片机模块,
其中,所述VN-200芯片和组合传感器分别安装在所述印制电路板上;
所述频率选择模块用于基于用户控制进行通信频率选择;
所述VN-200芯片用于测量所述集成式惯性导航测量单元所安装位置的GPS定位、横摆角速度、侧向加速度以及X、Y、Z三个方向的加速度;
所述组合传感器用于测量所述集成式惯性导航测量单元所安装位置的横摆角速度和侧向加速度;
所述三轴加速度计模块用于测量所述集成式惯性导航测量单元所安装位置的X、Y、Z三个方向的加速度;
所述内部电源用于通过电源稳压模块和电源转换模块为测量单元供电;
所述单片机模块用于对所测得信号进行检测和补偿。
2.根据权利要求1所述的集成式惯性导航测量单元,其特征在于,所述集成式惯性导航测量单元还包括:第一压线端子、第二压线端子、RS-232串口驱动模块、连接器、按键开关、锂电池、接插件、CAN驱动模块、在线调试模块以及报警模块。
3.根据权利要求2所述的集成式惯性导航测量单元,其特征在于,所述VN-200芯片、组合传感器、频率选择模块、CAN驱动模块、三轴加速度计模块、单片机模块、在线调试模块和报警模块彼此直接或间接电气相连;所述单片机模块接收并处理来自经RS-232串口驱动模块转换后的所述VN-200芯片的信号以及频率选择模块和三轴加速度计模块的信号;所述CAN驱动模块通过接插件和被测车辆的CAN网络相连。
4.一种利用权利要求1-3中任意一项所述的集成式惯性导航测量单元对车辆运动信息的进行测量的方法,其特征在于,所述方法包括:
步骤1、检测所述集成式惯性导航测量单元的上电信号,当检测到上电信号时,利用所述单片机模块采集所述内部电源的电压和所述VN-200芯片的头文件,当所述内部电源的电压低于预定阈值时发出报警信号,提示进行电源充电或切换至外部蓄电池;如果所述VN-200芯片的头文件符合预定要求则转至步骤2,否则发出报警信号;
步骤2、设置所述集成式惯性导航测量单元的CAN总线的信号输出频率;
步骤3、所述单片机模块分别接收来自所述VN-200芯片的ASCII码形式的信号、组合传感器的CAN信号和三轴加速度计模块的二进制码形式的信号,当所述单片机模块部分接收到或全部接收到上述三种信号时,产生相应中断,并在中断函数中将ASCII码接收标志位ASCII_flag赋1;否则,等待接收;
步骤4、当所述单片机模块确定ASCII_flag=1时,跳出中断,进入到所述VN-200芯片与所述组合传感器的CAN信号或所述三轴加速度计的二进制信号对应的ASCII码解析函数当中;
步骤5、根据接收到的ASCII码,查找美国标准信息交换代码表,得到对应的十进制数;根据所述组合传感器的CAN协议和三轴加速度计的二进制代码协议可得到对应的十进制数;
步骤6、将解析出来的ASCII码按位权加和,获得表征集成式惯性导航测量单元所测得参数的状态量;
步骤7、对从所述VN-200芯片测得的数据以及从所述组合传感器和三轴加速度计测得的数据进行坐标归一化;
步骤8、对从所述VN-200芯片测得的数据以及从所述组合传感器和三轴加速度计测得的数据进行互检校验以及自检校验,并根据步骤2设定的发送频率进行插值运算,最终以CAN信号的形式、按设定的频率输出校验后的测量数据。
5.根据权利要求4所述的方法,其特征在于,所述步骤6包括:
步骤6.1、根据所述组合传感器测得的数据,解析出侧向加速度N_ay和横摆角速度N_yawRate;
步骤6.2、根据所述三轴加速度计测得的数据解析出来自所述三轴加速度计的纵向加速度F_ax、侧向加速度F_ay和垂向加速度F_az;
步骤6.3、根据VN-200芯片测得的数据解析出侧向加速度VN_ay、横摆角速度VN_yawRate、纵向加速度VN_ax和垂向加速度VN_az。
6.根据权利要求5所述的方法,其特征在于,所述步骤8包括:
将来自所述组合传感器的侧向加速度N_ay、横摆角速度N_yawRate,来自所述三轴加速度计的纵向加速度F_ax、侧向加速度F_ay和垂向加速度F_az与来自所述VN-200芯片的侧向加速度VN_ay、横摆角速度VN_yawRate、纵向加速度VN_ax和垂向加速度VN_az分别作差。
CN201610355456.9A 2016-05-26 2016-05-26 一种集成式惯性导航测量单元及相应测量方法 Active CN105823484B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610355456.9A CN105823484B (zh) 2016-05-26 2016-05-26 一种集成式惯性导航测量单元及相应测量方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610355456.9A CN105823484B (zh) 2016-05-26 2016-05-26 一种集成式惯性导航测量单元及相应测量方法

Publications (2)

Publication Number Publication Date
CN105823484A true CN105823484A (zh) 2016-08-03
CN105823484B CN105823484B (zh) 2017-06-23

Family

ID=56530571

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610355456.9A Active CN105823484B (zh) 2016-05-26 2016-05-26 一种集成式惯性导航测量单元及相应测量方法

Country Status (1)

Country Link
CN (1) CN105823484B (zh)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107014564A (zh) * 2017-05-25 2017-08-04 天津恒天新能源汽车研究院有限公司 一种用于电动汽车的惯性测量单元
CN109144091A (zh) * 2018-11-06 2019-01-04 广州极飞科技有限公司 一种飞行控制器及无人飞行器
CN110567457A (zh) * 2019-09-09 2019-12-13 深圳市科卫泰实业发展有限公司 一种基于冗余的惯导自检测系统
CN112505409A (zh) * 2020-11-18 2021-03-16 东南大学 一种多通道的高精度传感器采集系统及其频率测量方法
CN112577484A (zh) * 2019-09-29 2021-03-30 北京信息科技大学 一种小型气象探测设备应用的遥测装置
CN113008244A (zh) * 2021-02-25 2021-06-22 广州导远电子科技有限公司 导航信息的处理方法、装置、电子设备及存储介质
CN113280813A (zh) * 2021-05-31 2021-08-20 智道网联科技(北京)有限公司 基于神经网络模型的惯性测量数据补偿方法及装置
WO2021208190A1 (zh) * 2020-04-14 2021-10-21 上海华测导航技术股份有限公司 导航板卡、用于导航板卡的多源数据融合方法以及运载体
CN113899915A (zh) * 2021-09-28 2022-01-07 湖南三一智能控制设备有限公司 一种臂架线速度获取方法、装置及工程车辆

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2009043183A1 (en) * 2007-10-04 2009-04-09 University Technologies International System and method for intelligent tuning of kalman filters for ins/gps navigation applications
CN101509768A (zh) * 2009-03-26 2009-08-19 清华大学 基于低成本加速度传感器的车载道路坡度识别装置及方法
CN101598549A (zh) * 2009-07-06 2009-12-09 北京航空航天大学 一种车辆行驶坡度与相对高度动态估计方法
CN201583271U (zh) * 2009-09-18 2010-09-15 上海通用汽车有限公司 用于连续测量道路的坡度值的设备
CN102313535A (zh) * 2011-06-29 2012-01-11 惠州市德赛西威汽车电子有限公司 坡度检测方法
CN102455184A (zh) * 2010-10-29 2012-05-16 刘胜 惯性测量单元
CN103322978A (zh) * 2013-06-20 2013-09-25 张家港保税区润桐电子技术研发有限公司 基于嵌入式系统的车载道路坡度识别装置
CN103335633A (zh) * 2013-06-20 2013-10-02 张家港保税区润桐电子技术研发有限公司 基于嵌入式系统的车载道路坡度识别装置
CN103661393A (zh) * 2012-08-31 2014-03-26 福特全球技术公司 运动学道路坡度估计
CN104359481A (zh) * 2014-11-12 2015-02-18 中国兵器工业集团第二一四研究所苏州研发中心 一种基于fpga的微小型惯性测量单元
CN104422948A (zh) * 2013-09-11 2015-03-18 南京理工大学 一种嵌入式组合导航系统及其方法
CN105333870A (zh) * 2015-12-15 2016-02-17 中国电子科技集团公司第二十六研究所 一种微型复合导航电路

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2009043183A1 (en) * 2007-10-04 2009-04-09 University Technologies International System and method for intelligent tuning of kalman filters for ins/gps navigation applications
CN101509768A (zh) * 2009-03-26 2009-08-19 清华大学 基于低成本加速度传感器的车载道路坡度识别装置及方法
CN101598549A (zh) * 2009-07-06 2009-12-09 北京航空航天大学 一种车辆行驶坡度与相对高度动态估计方法
CN201583271U (zh) * 2009-09-18 2010-09-15 上海通用汽车有限公司 用于连续测量道路的坡度值的设备
CN102455184A (zh) * 2010-10-29 2012-05-16 刘胜 惯性测量单元
CN102313535A (zh) * 2011-06-29 2012-01-11 惠州市德赛西威汽车电子有限公司 坡度检测方法
CN103661393A (zh) * 2012-08-31 2014-03-26 福特全球技术公司 运动学道路坡度估计
CN103322978A (zh) * 2013-06-20 2013-09-25 张家港保税区润桐电子技术研发有限公司 基于嵌入式系统的车载道路坡度识别装置
CN103335633A (zh) * 2013-06-20 2013-10-02 张家港保税区润桐电子技术研发有限公司 基于嵌入式系统的车载道路坡度识别装置
CN104422948A (zh) * 2013-09-11 2015-03-18 南京理工大学 一种嵌入式组合导航系统及其方法
CN104359481A (zh) * 2014-11-12 2015-02-18 中国兵器工业集团第二一四研究所苏州研发中心 一种基于fpga的微小型惯性测量单元
CN105333870A (zh) * 2015-12-15 2016-02-17 中国电子科技集团公司第二十六研究所 一种微型复合导航电路

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
CHOT HUN LIM,TIEN SZE LIM,VOON CHET KOO: "Stochastic Error Modeling of MEMS Inertial Sensor with Implementation to GPS-aided INU System for UAV Motion Sensing", 《APPLIED MECHANICS AND MATERIALS》 *
张欣: "基于嵌入式系统和MEMS的惯性测量单元的研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
汪旭明: "道路坡度测试方法试验研究", 《农业装备与车辆工程》 *

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107014564A (zh) * 2017-05-25 2017-08-04 天津恒天新能源汽车研究院有限公司 一种用于电动汽车的惯性测量单元
CN109144091A (zh) * 2018-11-06 2019-01-04 广州极飞科技有限公司 一种飞行控制器及无人飞行器
CN110567457A (zh) * 2019-09-09 2019-12-13 深圳市科卫泰实业发展有限公司 一种基于冗余的惯导自检测系统
CN110567457B (zh) * 2019-09-09 2023-03-03 深圳市科卫泰实业发展有限公司 一种基于冗余的惯导自检测系统
CN112577484A (zh) * 2019-09-29 2021-03-30 北京信息科技大学 一种小型气象探测设备应用的遥测装置
US11789163B2 (en) 2020-04-14 2023-10-17 Shanghai Huace Navigation Technology Ltd Navigation board, multi-source data fusion method for navigation board and transporter
WO2021208190A1 (zh) * 2020-04-14 2021-10-21 上海华测导航技术股份有限公司 导航板卡、用于导航板卡的多源数据融合方法以及运载体
CN112505409A (zh) * 2020-11-18 2021-03-16 东南大学 一种多通道的高精度传感器采集系统及其频率测量方法
WO2022179602A1 (zh) * 2021-02-25 2022-09-01 广州导远电子科技有限公司 导航信息的处理方法、装置、电子设备及存储介质
CN113008244B (zh) * 2021-02-25 2023-07-14 广州导远电子科技有限公司 导航信息的处理方法、装置、电子设备及存储介质
CN113008244A (zh) * 2021-02-25 2021-06-22 广州导远电子科技有限公司 导航信息的处理方法、装置、电子设备及存储介质
CN113280813B (zh) * 2021-05-31 2022-12-16 智道网联科技(北京)有限公司 基于神经网络模型的惯性测量数据补偿方法及装置
CN113280813A (zh) * 2021-05-31 2021-08-20 智道网联科技(北京)有限公司 基于神经网络模型的惯性测量数据补偿方法及装置
CN113899915A (zh) * 2021-09-28 2022-01-07 湖南三一智能控制设备有限公司 一种臂架线速度获取方法、装置及工程车辆
CN113899915B (zh) * 2021-09-28 2024-06-04 湖南三一智能控制设备有限公司 一种臂架线速度获取方法、装置及工程车辆

Also Published As

Publication number Publication date
CN105823484B (zh) 2017-06-23

Similar Documents

Publication Publication Date Title
CN105823484A (zh) 一种集成式惯性导航测量单元及相应测量方法
CN108398611B (zh) 基于最小电池管理系统的功能测试系统及其测试方法
CN105676843B (zh) 一种新能源汽车对标分析与评价系统及其方法
CN101359036B (zh) 电池荷电状态的测定方法
CN110174625B (zh) 一种动力电池组电阻绝缘监测系统及监测算法
CN103781653B (zh) 蓄电池管理系统、具有蓄电池管理系统的蓄电池和机动车以及用于监控蓄电池的方法
CN106403945A (zh) 一种低成本的物体姿态监测系统及方法
CN108663045A (zh) 一种骑行载具姿态识别报警方法和姿态监测报警装置
CN109342080A (zh) 基于陀螺仪的车辆可靠性测试数据收集分析系统
CN104053978A (zh) 符合标准的集成数据采集设备
CN105899419A (zh) 中途故障诊断系统及安装了该中途故障诊断系统的电动助力转向装置
CN106329014A (zh) 一种无人机电池组管理方法及装置
CN108614217A (zh) 一种电池管理系统全自动测试系统及实现方法
CN109916362B (zh) 一种方向盘转动角度的检测方法及系统
KR20220121932A (ko) 차량 배터리 모니터링 시스템
CN106681306A (zh) 一种电池管理系统集成测试平台
CN202471751U (zh) 一种模拟车速及发动机转速的信号发生器
CN202130320U (zh) 智能车载蓄电池能量表
US12107239B2 (en) Method for matching data of a first control unit with a second control unit for determining precise predictive values
CN211642196U (zh) 列车平稳性检测系统
Visconti et al. A ST X-Nucleo-based telemetry unit for detection and WiFi transmission of competition car sensors data: firmware development, sensors testing and real-time data analysis
CN201882012U (zh) 混合动力残疾人摩托车车载信息系统
CN114132203A (zh) 基于温湿度智能调节的充电桩控制系统
CN207366715U (zh) 一种基于can总线的电池soc估算装置
CN102001392A (zh) 混合动力残疾人摩托车车载信息系统

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20160803

Assignee: TIANJIN SOTEREA AUTOMOTIVE TECHNOLOGY Co.,Ltd.

Assignor: TSINGHUA University

Contract record no.: X2020990000173

Denomination of invention: Integrated inertial navigation measuring unit and corresponding measuring method

Granted publication date: 20170623

License type: Common License

Record date: 20200413

EE01 Entry into force of recordation of patent licensing contract