1.一种露天矿山无人驾驶重载车辆路径跟踪控制方法,其特征在于,包括:
前进路径跟踪步骤:根据预先设置的路径信息和车辆状态信息,用下式(1)所示的新Stanley控制器控制露天矿山重载车辆前进时的路径跟踪控制,新Stanley控制器考虑有车辆转向器时滞特性、车辆尺寸和前进行驶速度:式中,δc为前轮转角指令,ep为横向距离误差,vf为车辆的前进行驶速度,为角度误差,Δt为系统采样时间,τδ为时滞因子,k为自适应调整控制增益,为车辆的前进加速度,δ为车辆的前轮转角,crp为最近路径点对应的曲率;
后退路径跟踪步骤:用下式所示的新后轮反馈控制器控制露天矿山重载车辆后退时的路径跟踪控制,新后轮反馈控制器考虑有车辆转向器时滞特性、车辆尺寸和后退行驶速度:式中,δc为前轮转角指令,L为轴距,cr为最近路径点对应曲率,为最近路径点对应曲率的变化率,为横摆角误差,er为横向距离误差,为横摆角误差对应的比例因子,ke为横向距离误差对应的比例影子,τδ为时滞因子,vr为正值的车辆后退行驶速度,为车辆横摆角速度。
2.如权利要求1所述的露天矿山无人驾驶重载车辆路径跟踪控制方法,其特征在于,新Stanley控制器还根据露天矿山重载车辆的车辆信息和行驶特性,利用下式(6)至(8)提供的动态选择方法确定预瞄距离dp:dp=max{dpv,dpc} (6)dpv=kpvvfΔt (7)
式中,dpv为根据vf获得的预瞄距离,kpv为比例因子,dpc为根据crp标定的预瞄距离,dhc、dmc、dlc分别为根据数值不同的crp标定的预瞄距离。
3.如权利要求2所述的露天矿山无人驾驶重载车辆路径跟踪控制方法,其特征在于,新Stanley控制器还根据露天矿山重载车辆的车辆信息和行驶特性,利用下式(11)确定自适应调整控制增益k:其中,κ1和κ2为无纲量比例因子。
4.如权利要求1-3中任一项所述的露天矿山无人驾驶重载车辆路径跟踪控制方法,其特征在于,新后轮反馈控制器还根据露天矿山重载车辆的车辆信息和行驶特性,利用下式(12)提供的动态选择方法确定预瞄距离:式中,dpr为根据crp标定的预瞄距离,dhr、dmr、dlr分别为根据数值不同的crp标定的预瞄距离。
5.一种露天矿山无人驾驶重载车辆路径跟踪控制装置,其特征在于,包括:
新Stanley控制器,其用于根据露天矿山重载车辆的车辆信息和行驶特性,控制露天矿山重载车辆前进时的路径跟踪控制,新Stanley控制器考虑有车辆转向器时滞特性,如下式(1)所示:式中,δc为前轮转角指令,ep为横向距离误差,vf为车辆的前进速度,为角度误差,Δt为系统采样时间,τδ为时滞因子,k为自适应调整控制增益,为车辆的前进加速度,δ为车辆的前轮转角,crp为最近路径点对应的曲率;
新后轮反馈控制器,其用于控制露天矿山重载车辆后退时的路径跟踪控制,新后轮反馈控制器考虑有车辆转向器时滞特性和车辆后退时的特性,如下式所示:式中,δc为前轮转角指令,L为轴距,cr为最近路径点对应曲率,为最近路径点对应曲率的变化率,为横摆角误差,er为横向距离误差,为横摆角误差对应的比例因子,ke为横向距离误差对应的比例影子,τδ为时滞因子,vr为正值的车辆后退行驶速度,为车辆横摆角速度。
6.如权利要求5所述的露天矿山无人驾驶重载车辆路径跟踪控制装置,其特征在于,新Stanley控制器还根据露天矿山重载车辆的车辆信息和行驶特性,利用下式(6)至(8)提供的动态选择方法确定预瞄距离dp:dp=max{dpv,dpc} (6)dpv=kpvvfΔt (7)
式中,dpv为根据vf获得的预瞄距离,kpv为比例因子,dpc为根据crp标定的预瞄距离,dhc、dmc、dlc分别为根据数值不同的crp标定的预瞄距离。
7.如权利要求6所述的露天矿山无人驾驶重载车辆路径跟踪控制装置,其特征在于,新Stanley控制器还根据露天矿山重载车辆的车辆信息和行驶特性,利用下式(11)确定自适应调整控制增益k:其中,κ1和κ2为无纲量比例因子。
8.如权利要求5-7中任一项所述的露天矿山无人驾驶重载车辆路径跟踪控制装置,其特征在于,新后轮反馈控制器还根据露天矿山重载车辆的车辆信息和行驶特性,利用下式(12)提供的动态选择方法确定预瞄距离:式中,dpr为根据crp标定的预瞄距离,dhr、dmr、dlr分别为根据数值不同的crp标定的预瞄距离。
9.一种露天矿山无人驾驶重载车辆,包括车体,车体的尺寸结构为:车身长度为14.75米,车身宽度为7.44米,前保险杠离地高度为1.42米,轴距为6.35米,前悬长度为4.25米,后悬长度为3.43米,前轮最大转角31度,车辆前进行驶速度范围为0-30千米每小时,车辆后退行驶速度范围为0-10千米每小时;其特征在于,还包括:惯性导航组合设备,用于获取车辆状态信息;
无人驾驶计算平台,其预先设置有如权利要求5-8中任一项所述的露天矿山无人驾驶重载车辆路径跟踪控制装置,计算前轮转角指令δc,并将δc发送到车辆线控接口单元;
线控转向单元,其用于接收通过can总线接收δc,并按照δc控制车辆按照期望路径行驶。
10.如权利要求9所述的露天矿山无人驾驶重载车辆,其特征在于,线控转向单元包括带有电控系统的全液压转向器。