主权项: |
一种汽车行驶过程中的状态估计方法,其特征在于,包括以下步骤:步骤1:建立汽车运动模型:建立汽车载体坐标系XRYRZR,选择后轴中点Mr作为载体坐标系的原点O;选择指向汽车的右手方向为XR轴,沿着汽车纵轴并指向汽车前进的方向为YR轴,ZR轴指向汽车天顶方向;定义二维坐标系XIOIYI,令该坐标系与导航坐标系ENU的EO′N平面重合,XI指向东,YI指向北,XIOIYI平面即为汽车运动的二维全局坐标系,导航坐标系ENU为汽车运动的三维全局坐标系;汽车运动模型由下式来表达:为汽车后轮在全局坐标系中的位姿矢量,vy为汽车后轮速率,l为轴距,为整车的虚拟转向角,通过方向盘转向参数测试仪测定,θ为汽车的方向角即航向角;步骤2:对汽车行驶过程中的状态参数进行估计所述的状态参数包括估计速度值v′y,汽车在导航坐标系ENU即XIYIZI系中的速度矢量表示为VI=[ve,vn,vu]T,其中ve、vn和vu分别代表了载体的东向、北向和天向速度;v′y=sinθcosψve+cosθcosψvn+sinψvu,其中ψ为俯仰角,其中ve、vn和vu、ψ和θ变量通过GPS组合导航仪测量求得;评判估计的精度为其中vy为汽车实际速度。FDA0000069671600000011.tif,FDA0000069671600000012.tif,FDA0000069671600000013.tif,FDA0000069671600000014.tif,FDA0000069671600000015.tif |