欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2022105366606
申请人: 浙江工业大学
专利类型:发明专利
专利状态:已下证
专利领域: 测量;测试
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种车载组合导航设备姿态自适应估计方法,其特征在于,应用于车载组合导航系统,包括惯性传感器IMU和GNSS模块,所述方法包括:S1,传感器数据采集和校正;

S2,计算导航设备姿态角的俯仰角和横滚角;在平直路面且车体静止状态t0下,计算导航设备姿态角的俯仰角θp(t0)和横滚角θr(t0);俯仰角计算公式为:,横滚角计算公式为:,其中,x、y、z分别为三轴加速度x轴、y轴、z轴的加速度值;

S3,设置导航系统状态并初始化,包括以下步骤:

S3.1,设置导航设备相对车体的姿态角,为导航设备相对车体的俯仰角,,为导航设备相对车体的横滚角,,为导航设备相对车体的航向角,初值为0;

S3.2,设置导航系统的姿态角,为导航系统的俯仰角,初值为步骤S2所得的俯仰角θp(t0),为导航系统的横滚角,初值为步骤S2所得的横滚角θr(t0),为导航系统的航向角,,其中,θgnss为在车速大于速度阈值Vh时,基于GNSS模块获取的车体航向角;

S3.3,由GNSS模块获取的全局位置和三维速度信息分别初始化导航系统的速度和位置;

S4,组合导航算法初始化;

S5,对当前导航系统状态进行惯导推算;

S6,车辆状态识别;

S7,基于车辆状态选择卡尔曼滤波器的误差观测矩阵;

S8,由卡尔曼滤波器估计导航系统状态误差,并进行当前导航系统状态的误差修正;

S9,评定导航设备安装姿态的估计结果,包括以下步骤:S9.1,基于获取导航设备相对车体的当前航向角;

S9.2,当检测到导航设备相对车体的当前航向角收敛到方差小于一定阈值时认为估计完毕,否则返回步骤S5。

2.如权利要求1所述的一种车载组合导航设备姿态自适应估计方法,其特征在于,所述S1包括以下步骤:S1.1,按照一定采样频率分别采集惯性传感器IMU的惯性传感器信息、CAN总线的车速度信息及GNSS模块的GNSS输出信息,并标记采样时间戳,惯性传感器IMU包括三轴加速度计和三轴角速度计,惯性传感器信息包括三轴加速度数据和三轴角速度数据;

S1.2,采用二阶巴特沃斯低通滤波器对三轴加速度数据进行滤波,采用滑动窗口对三轴角速度数据进行滤波。

3.如权利要求1所述的一种车载组合导航设备姿态自适应估计方法,其特征在于,所述S4包括以下步骤:设置导航坐标系到载体坐标系的导航变换矩阵,并基于导航系统姿态角的初值初始化导航变换矩阵;

设置车体坐标系到载体坐标系的车体变换矩阵,并基于导航设备相对车体姿态角的初值初始化车体变换矩阵;

基于导航变换矩阵获取对应的四元素初值;

设定卡尔曼滤波器的状态向量,包括姿态误差、速度误差、位置误差、角速度计动态零漂、加速度计动态零漂;

设定卡尔曼滤波器的状态转移矩阵。

4.如权利要求1所述的一种车载组合导航设备姿态自适应估计方法,其特征在于,基于导航变换矩阵、车体变换矩阵及四元素初值,采用捷联惯导更新方程进行惯导解算,更新导航系统状态。

5.如权利要求1所述的一种车载组合导航设备姿态自适应估计方法,其特征在于,所述车辆状态识别包括:车身速度小于vstop、加速度值方差小于阈值且持续时间大于tstop时,则为停止状态;

角速度计Z轴角速度值投影到车体坐标系后的绝对值小于wbstraight且车身速度大于vstraight时,车辆处于高速直行状态;

角速度计Z轴角速度值投影到车体坐标系后的绝对值大于wbturn时,车辆处于转弯状态;

否则为其他状态;

其中,vstop为预设的车辆停止时的速度阈值,tstop为预设的车辆停止时的持续时间阈值,wbstraight为预设的车辆直行时的角速度阈值,vstraight为预设的车辆直行时的速度阈值,wbturn为预设的车辆转弯时的角速度阈值。

6.如权利要求5所述的一种车载组合导航设备姿态自适应估计方法,其特征在于,所述S7包括:当车辆处于静止状态,卡尔曼滤波器的观测矩阵H设置为观测三维速度误差,噪声矩阵R设置为常数,观测向量Z为车体在导航坐标系下的三维速度;

当车辆处于转弯状态或高速直行状态时,卡尔曼滤波器的观测矩阵H设置为观测三维速度和位置误差,噪声矩阵R由角速度计和卫星信噪比按预设的自适应计算公式进行自适应调整,观测向量Z为车身在导航坐标系下的三维速度误差和位置误差。

7.如权利要求6所述的一种车载组合导航设备姿态自适应估计方法,其特征在于,所述自适应计算公式为R=N1×P900/CN0-0.7+N2×Qabs(wbz)*10,其中,N1、N2、Q和P为常数,CN0为GNSS信噪比,wbz为车体转向角速度值。