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

摘要:

权利要求书:

1.一种基于履带车辆地面力学特性的土壤参数估计方法,其特征在于,包括:

S10,采集履带车辆在预设时间段[(j-N)*T,t]内的位姿信息Pobs,获得观测信息序列Pobs=[Xobs,Yobs,θobs],Xobs为履带车辆在大地坐标系下的横坐标,Yobs为履带车辆在大地坐标系下的纵坐标,θobs为履带车辆的横摆角,j为当前时刻,N为采样点数量,T为采样时间步长;

S20,结合观测信息序列与路径跟踪控制中速度指令序列{V1,V2,…,VN},获取履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α,再根据al、ar和α与速度指令序列{V1,V2,…,VN},获得履带车辆单侧履带的牵引力F;中,为履带车辆在采样时刻N理想的左侧履带速度,为履带车辆在采样时刻N理想的右侧履带速度;

S30,根据履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α,利用下式(13)获取内聚力参数c、内摩擦角φ以及剪切模量k;

式中,F为由电机模型根据al、ar和α和速度指令序列{V1,V2,…,VN}获取的单侧履带的牵引力,b为单侧履带宽度,L为单侧履带接地长度,c为内聚力系数,m为履带车辆的质量,g为重力加速度,φ为内摩擦角,k为剪切模量,a为al或ar;

步骤S20获取履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α时,将履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α设置为待求状态量u=[al,ar,α],将用于参数估计的状态方程设置为下式(1):uj=uj-1+wj (1)

式中,uj-1为履带车辆在当前时刻j-1的状态量,uj为履带车辆在时刻j的状态量,wj为当前时刻j的状态方程噪声;

步骤S20获取履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α时,采用无迹卡尔曼滤波获取履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α。

2.如权利要求1所述的基于履带车辆地面力学特性的土壤参数估计方法,其特征在于,具体包括:

S221,根据时刻j-1的状态估计协方差矩阵εj-1,用下式(2)计算时刻j-1的σ采样点集合Xj-1,用式(4)计算σ采样点集合Xj-1中第i个σ采样点在当前时刻j的值从而由获得σ采样点集合在当前时刻j的集合最后利用下式(5)计算第i个σ采样点所对应的权值:Zj=ΔP(j)pre-ΔP(j)obs+vj  (3)

式中,n为状态量的数量,λ为无实质物理、用于简化公式的中间参数,λ=α12(n+κ)-n,α1与κ为确定σ采样点分布的比例参数,εj-1为时刻j-1的状态估计协方差矩阵,μj-1为履带车辆在时刻j-1的状态量;g(τj,Xj-1)为观测方程,τj为当前时刻j的履带车辆的控制量,Zj为当前时刻j的观测量,ΔP(k)pre为通过理想履带车辆运动方程预测得到的单位时间步长内履带车辆位姿的变化量,ΔP(k)obs为通过传感器观测得到的单位时间步长内履带车辆位姿的变化量,vj为当前时刻j的观测方程噪声,为第i个σ采样点的预测用权值,为第0个σ采样点的预测用权值,为第i个σ采样点的协方差矩阵权值,为第0个σ采样点的协方差矩阵权值,i=1,…,2n,n为状态量的数量,β为计算过程的中间参数;

S222,根据步骤S221获得的σ采样点集合在当前时刻j的集合和每一个σ采样点所对应的权值,用式(6)计算当前时刻j预测的状态量均值用下式(7)计算当前时刻j预测的状态量协方差矩阵式中,Rj为当前时刻j的状态量噪声的协方差矩阵;

S223,用式(3)映射获得第i个σ采样点在当前时刻j的观测值将与步骤S221获得的第i个σ采样点的预测用权值通过下式(8)结合,计算得到在当前时刻j预测的观测值将与步骤S221获得的第i个σ采样点的协方差矩阵权值通过下式(9)结合,计算得到观测值的不确定性矩阵Sj;再将和与步骤S221获得的第i个σ采样点的协方差矩阵权值通过下式(10)结合,计算得到在当前时刻j关于x和z的互协方差矩阵式中,Qj为当前时刻j的观测方程噪声的协方差矩阵,为第i个σ采样点在当前时刻j的值;

S224,将步骤S221获得的当前时刻j的观测量Zj,步骤S222获得的预测的状态量均值预测的状态量协方差矩阵步骤S223获得的预测的观测值不确定性矩阵Sj、互协方差矩阵通过下式(11)结合,计算得到在当前时刻j的卡尔曼增益Kj,再使用N个位姿信息Pobs的历史数据进行迭代,得到状态量的最优估计值式中,为Sj的逆矩阵,为在当前时刻j的状态量uj的最优估计值,Σj为在当前时刻j预测的最优估计状态量协方差矩阵。

3.一种基于履带车辆地面力学特性的土壤参数估计装置,其特征在于,包括:

定位感知单元,其用于采集履带车辆在预设时间段[(j-N)*T,t]内的位姿信息Pobs,获得观测信息序列Pobs=[Xobs,Yobs,θobs],Xobs为履带车辆在大地坐标系下的横坐标,Yobs为履带车辆在大地坐标系下的纵坐标,θobs为履带车辆的横摆角,j为当前时刻,N为采样点数量,T为采样时间步长;

滑动参数估计单元,其用于接收定位感知单元获取的环境信息与履带车辆位姿信息,并结合观测信息序列与路径跟踪控制中速度指令序列{V1,V2,…,VN},获取履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α;中,为履带车辆在采样时刻N理想的左侧履带速度,为履带车辆在采样时刻N理想的右侧履带速度;

土壤参数估计单元,其用于根据履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α,利用下式(13)获取内聚力参数c、内摩擦角φ以及剪切模量k;

式中,F为由电机模型根据al、ar和α和速度指令序列{V1,V2,…,VN}获取的单侧履带的牵引力,b为单侧履带宽度,L为单侧履带接地长度,c为内聚力系数,m为履带车辆的质量,g为重力加速度,φ为内摩擦角,k为剪切模量,a为al或ar;

滑动参数估计单元包括状态方程设置子单元;

状态方程设置子单元用于将履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α设置为待求状态量u=[al,ar,α],将用于参数估计的状态方程设置为下式(1):uj=uj-1+wj  (1)

式中,uj-1为履带车辆在当前时刻j-1的状态量,uj为履带车辆在时刻j的状态量,wj为当前时刻j的状态方程噪声;

滑动参数估计单元获取履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α时,采用无迹卡尔曼滤波获取履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α。

4.如权利要求3所述的基于履带车辆地面力学特性的土壤参数估计装置,其特征在于,滑动参数估计单元包括:第一计算子单元,其用于根据时刻j-1的状态估计协方差矩阵εj-1,用下式(2)计算时刻j-1的σ采样点集合Xj-1,用式(4)计算σ采样点集合Xj-1中第i个σ采样点在当前时刻j的值从而由获得σ采样点集合在当前时刻j的集合最后利用下式(5)计算第i个σ采样点所对应的权值:Zj=ΔP(j)pre-ΔP(j)obs+vj  (3)

式中,n为状态量的数量,λ为无实质物理、用于简化公式的中间参数,λ=α12(n+κ)-n,α1与k为确定σ采样点分布的比例参数,εj-1为时刻j-1的状态估计协方差矩阵,μj-1为履带车辆在时刻j-1的状态量;g(τj,Xj-1)为观测方程,τj为当前时刻j的履带车辆的控制量,Zj为当前时刻j的观测量,ΔP(k)pre为通过理想履带车辆运动方程预测得到的单位时间步长内履带车辆位姿的变化量,ΔP(k)obs为通过传感器观测得到的单位时间步长内履带车辆位姿的变化量,vj为当前时刻j的观测方程噪声,为第i个σ采样点的预测用权值,为第0个σ采样点的预测用权值,为第i个σ采样点的协方差矩阵权值,为第0个σ采样点的协方差矩阵权值,i=1,…,2n,n为状态量的数量,β为计算过程的中间参数;

第二计算子单元,其用于根据σ采样点集合在当前时刻j的集合和每一个σ采样点所对应的权值,用式(6)计算当前时刻j预测的状态量均值用下式(7)计算当前时刻j预测的状态量协方差矩阵式中,Rj为当前时刻j的状态量噪声的协方差矩阵;

第三计算子单元,其用于用式(3)映射获得σ采样点集合Xj-1中第i个σ采样点在当前时刻j的观测值将与第i个σ采样点的预测用权值通过下式(8)结合,计算得到在当前时刻j预测的观测值将与第i个σ采样点的协方差矩阵权值通过下式(9)结合,计算得到观测值的不确定性矩阵Sj;再将和与第i个σ采样点的协方差矩阵权值通过下式(10)结合,计算得到在当前时刻j关于x和z的互协方差矩阵式中,Qj为当前时刻j的观测方程噪声的协方差矩阵,为第i个σ采样点在当前时刻j的值;

第四计算子单元,其用于将当前时刻j的观测量Zj,预测的状态量均值预测的状态量协方差矩阵预测的观测值不确定性矩阵Sj、互协方差矩阵通过下式(11)结合,计算得到在当前时刻j的卡尔曼增益Kj,再使用N个位姿信息Pobs的历史数据进行迭代,得到状态量的最优估计值式中,为Sj的逆矩阵,为在当前时刻j的状态量uj的最优估计值,Σj为在当前时刻j预测的最优估计状态量协方差矩阵。

5.如权利要求4所述的基于履带车辆地面力学特性的土壤参数估计装置,其特征在于,还包括:

决策规划单元,其用于接收定位感知单元获取的环境信息与履带车辆位姿信息,进行全局轨迹规划,并输出;

横纵向控制单元,其用于接收决策规划单元输出的参考轨迹以及滑动参数估计单元输出的履带车辆的左侧履带滑移率al、右侧履带滑移率ar、滑移角α,并获取速度指令序列{V1,V2,…,VN},输出给电机模型,底层执行单元,其用于根据接收到的单侧履带的牵引力F,计算相应的力矩,驱动车辆。

6.一种计算机可读存储介质,其上存储有程序,所述程序被计算机执行时,实现如权利要求1-2中任一项所述的方法。