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

摘要:

权利要求书:

1.一种智能履带车辆滑动参数实时估计方法,其特征在于:包括如下步骤:步骤1,建立基于瞬时转向中心的履带车辆运动学模型;

步骤2,根据传感器采集的车辆历史状态信息,利用所述基于瞬时转向中心的履带车辆运动学模型预测车辆历史时刻的相对位姿变化量,并将其与车辆历史位姿信息同时输入UKF进行迭代运算初步估计履带车辆滑动参数;

步骤3,将步骤2初步估计的履带车辆滑动参数作为第二层UKF的初值,并根据传感器采集的车辆当前时刻状态信息,分别利用车辆绝对速度与所述基于瞬时转向中心的履带车辆运动学模型预测车辆未来时刻的相对位姿变化量,将两者同初步估计的滑动参数一起输入第二层UKF进行迭代运算得到最终的履带车辆滑动参数;

所述步骤2中,所述根据传感器采集的车辆历史状态信息,利用所述基于瞬时转向中心的履带车辆运动学模型预测车辆历史时刻的相对位姿变化量,并将其与车辆历史位姿信息同时输入UKF进行迭代运算初步估计履带车辆滑动参数具体步骤为:l r T

步骤21,令滑动参数Rh=(y ,y ,xc) 作为非线性履带车辆系统的状态向量,系统输入为l r Tu=(v ,v ,θ,β,γ) ,观测量为Z=(Δx,Δy),预测量为Zh=(Δxh,Δyh),系统输入u为车辆历史状态信息,观测量Z为每个采样间隔车辆历史位姿的变化量;预测量Zh为每个采样间隔将已选取的Sigma点、车辆历史状态信息与滑动参数Rh输入车辆运动学模型得到的相对位姿变化量;利用UKF算法处理预测量Zh、观测量Z与非线性履带车辆系统的状态向量Rh,通过l r迭代运算初步估计履带车辆滑动参数y、y、xc

步骤22,由已选取的Sigma点、车辆历史状态信息与滑动参数Rh输入车辆运动学模型预测车辆历史时刻的相对位姿预测,即计算预测量Zh=(Δxh,Δyh):其中:

式中,Δt为系统采样时间;

步骤23,利用UKF算法处理测量预测量Zh、观测量Z与非线性履带车辆系统的状态向量l rRh,通过迭代运算初步估计履带车辆滑动参数y、y、xc。

2.根据权利要求1所述的智能履带车辆滑动参数实时估计方法,其特征在于:所述步骤

1中,建立基于瞬时转向中心的履带车辆运动学模型具体为:

其中:

式中,x、y分别为车辆的横纵坐标,θ、β、γ分别为车辆的横摆角、俯仰角和侧倾角,Vx、Vyl r分别为车辆纵向速度与横向速度,ω为车辆横摆角速度,xc为车辆瞬时转向中心,y 、y分别l r为左右侧履带瞬时转向中心,v、v分别为车辆左右侧履带接地段纵向速度。

3.根据权利要求1或2所述的智能履带车辆滑动参数实时估计方法,其特征在于:所述步骤3中,将步骤2初步估计的履带车辆滑动参数作为第二层UKF的初值,并根据传感器采集的车辆当前时刻状态信息,分别利用车辆绝对速度与所述基于瞬时转向中心的履带车辆运动学模型预测车辆未来时刻的相对位姿变化量,将两者同初步估计的滑动参数一起输入第二层UKF进行迭代运算得到最终的履带车辆滑动参数具体步骤为:步骤31,令滑动参数 作为非线性履带车辆系统的状态向量,下层

l r T

UKF迭代初值Rp0=Rh,系统输入为up=(v,v ,θ,β,γ) ,观测量为z=(Δxpv,Δypv),预测量zp=(ΔxpR,ΔypR),系统输入up为车辆当前时刻的状态信息,观测量z为利用车辆当前时刻绝对速度与横摆角速度来预测未来一段采样间隔内车辆位姿的变化量,预测量zp为将已选取的Sigma点、车辆当前时刻的状态信息up与滑动参数Rp输入车辆运动学模型得到未来一段采样间隔内相对位姿变化量,再次利用UKF算法处理测量预测量zh、观测量z与非线性履带车辆系统的状态向量Rp,通过迭代运算估计补偿后的履带车辆滑动参数 xcp;

步骤32,利用车辆当前时刻的绝对速度与横摆角速度来预测未来一段采样时间内车辆位姿的变化量,即计算观测量z:θk=ωv*k*Δt+θ0

式中,V、ωv分别为传感器测得的当前时刻车辆绝对速度与角速度,θ0为车辆初始横摆角,θk为预测的第k个采样时间车辆横摆角;

步骤33,由已选取的Sigma点、车辆当前时刻的状态信息up与滑动参数Rp通过车辆运动学模型预测未来一段采样时间内相对位姿变化量,即预测量zp:其中:

步骤34,再次利用UKF算法处理测量预测量zh、观测量z与非线性履带车辆系统的状态向量Rp,通过迭代运算估计补偿后的履带车辆滑动参数 xcp’最终系统输出的履带车辆滑动参数R=Rp。