1.一种兼顾避障的车辆轨迹跟踪鲁棒控制方法,其特征在于:包括如下步骤:步骤一,建立四轮独立驱动车辆纵横向动力学模型;
步骤二,建立轨迹跟踪等式约束模型;
步骤三,建立车辆避撞约束模型;
步骤四,设计约束跟随控制器;
步骤五,进行驱/制动力分解;
步骤六,将控制器部署至实车内;
其中步骤四中的设计约束跟随控制器如下:
U=p1+p2+p3
其中,
p1=B-1M1/2(AM-1/2)+(b-AM-1H)p2=-κB-1MAT(AAT)-1P-1β上式中,符号“+”表示矩阵的Moore-Penrose广义逆,κ>0,为常数参数,P∈R3×3且P>0,其中,α>0为一个接近0的常数参数,取值为0.1。
2.根据权利要求1所述的兼顾避障的车辆轨迹跟踪鲁棒控制方法,其特征在于:所述步骤一中的动力学模型包括纵向动力学模型、横向动力学模型和矩阵形式纵横向动力学模型;其中,纵向动力学模型如下:其中,m为车辆质量,ρa为空气密度,Ax为等效迎风面积,Ca为风阻系数,μ为滚动阻力系数,g为重力加速度,θ为道路坡道,ω1为建模误差和外部干扰的影响,ω1为时变有界的参数;
横向动力学模型如下:
其中,ω2、ω3为建模误差和外部干扰的影响,为时变有界的参数,a1~a8为车辆横向动力学参量;
矩阵形式纵横向动力学模型如下:
其中,为车辆的位置向量,x,y,分别为车辆的纵向位置、横向位置及横摆角;U=[Fx,δf,ΔM]T为车辆的控制输入,Fx,δf,δr分别为纵向驱/制动力、前轮转向角及后轮转向角,其他参数矩阵M、H、B、Ω分别可表示为:
3.根据权利要求2所述的兼顾避障的车辆轨迹跟踪鲁棒控制方法,其特征在于:所述横向动力学模型的车辆横向动力学参量由以下公式计算得出:其中,IZ为车辆绕重心垂直于水平面方向的转动惯量,kr为后轮侧偏刚度,kf为前轮侧偏刚度。
4.根据权利要求3所述的兼顾避障的车辆轨迹跟踪鲁棒控制方法,其特征在于:所述轨迹跟踪等式约束模型包括轨迹跟踪运动学模型和轨迹跟踪等式约束,其中,轨迹跟踪运动模型由以下步骤得出:步骤1,根据以下公式计算车辆期望的纵向位移xd:其中,vd(t)为期望速度;
步骤2,根据以下公式计算纵向位移跟踪误差ex:步骤3,根据以下公式计算速度跟随误差:
步骤4,根据以下公式计算四轮独立驱动车辆横摆角误差:其中,为期望横摆角,由期望路径上最近点处的切线方向角度确定,根据最近点处的期望路径曲率cR,可得到期望横摆角速度:步骤5,计算横摆角误差的一阶、二阶导数:
将车辆的横向误差ey定义为车辆距离期望路径的最小距离,根据运动学关系,其一阶、二阶导数可表示为:步骤6,假设车辆继续沿当前方向前进预瞄距离lp,在预瞄点处车辆与期望路径最近距离为预瞄横向误差ep,控制的目标为保证ep趋近于0,由几何关系可得到ep的近似表达式:步骤7,根据步骤5的公式得出ep的一阶、二阶导数:轨迹跟踪等式约束如下:
其中,h1>0、h2>0为常数参数,纵向位移误差ex和预瞄横向误差ep趋近于0。
5.根据权利要求4所述的兼顾避障的车辆轨迹跟踪鲁棒控制方法,其特征在于:所述步骤三中避撞约束模型包括无碰撞几何约束和避撞等式约束,其中,无碰撞集合约束如下:其中,(Xo,1,Yo,1)、(Xo,2,Yo,2)分别为描述自车包络的两个圆圆心在大地坐标系下的坐标,该坐标可通过车辆在大地坐标系下的位置[X,Y]T及横摆角计算,具体为l1、l2分别为两个圆心距离车辆重心的位置,为常数,Ro,1、Ro,2分别为这两个圆的半径,Δm为最小安全距离,(Xb,i,Yb,i)为第i个障碍物包络的圆心位置,Ri为圆半径;
避撞等式约束如下:
其中,为ea的一阶导数,ea为定义参数,具体的fj为不等式约束,且fj>0。
6.根据权利要求5所述的兼顾避障的车辆轨迹跟踪鲁棒控制方法,其特征在于:所述步骤五中驱动力分解的为按照预设驱/制动力分配规则将Fx和ΔM分解为四个车轮的驱/制动力Fx1~Fx4,分配规则如下:其中,lw为车辆轮距。
7.一种应用权利要求1至6任意一项所述的兼顾避障的车辆轨迹跟踪鲁棒控制方法的系统,其特征在于:包括环境感知模块、决策规划模块和车辆控制模块,其中环境感知模块用于自车信息、障碍物信息采集和环境感知等,决策规划模块用于搭载避障问题以求解最优避障以及车辆轨迹跟踪路径,车辆执行控制模块搭载执行上述方法的软件,执行决策规划模块发出的车辆底层控制指令。