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

摘要:

权利要求书:

1.一种铰接式车辆路径跟踪控制方法,其特征在于,包括以下步骤:步骤S1,根据已有的参考路径点作为前车体的参考点,计算出后车体的路径参考点;

步骤S2,获得车辆当前的位置;

步骤S3,在前桥参考路径上找到距离前桥最近的路径点,在后桥参考路径上找到距离后桥最近的路径点;

步骤S4,以距离前桥最近的点作为起点,向前行驶的前方搜索N个点,作为预瞄点,同理计算出后桥的预瞄点;

步骤S5,计算车辆前桥预瞄位置误差和航向误差,计算车辆后桥位置误差和航向误差;

步骤S6,将计算出的前桥的预瞄误差、航向误差与后桥的位置误差和航向误差输入到路径跟踪控制器中;

将车辆前桥简化为一个点,以车辆前桥的行驶方向为x轴,驾驶室左侧为y轴建立车辆坐标系,将预瞄点的坐标转化到车辆坐标系下,求解公式如下,然后计算出前桥的位置误差和航向误差;

yri+k=‑(Xfi+k‑xf(t))sinθf+(Yfi+k+yf(t))cosθf前桥的位置偏差df为:

df=yri+k

即:

df=‑(Xfi+k‑xf(t))sinθf+(Yfi+k+yf(t))cosθf前桥的航向偏差 为:

根据计算前桥的偏差计算,同样可以计算出后桥的偏差,位置偏差dr为:dr=‑(Xri+k‑xr(t))sinθr+(Yri+k+yr(t))cosθr后桥的航向偏差 为:

步骤S7,路径跟踪控制器计算出铰接式车辆铰接角速度对车辆进行转向控制;其中将计算出的前桥的位置偏差df与前桥的航向偏差 输入到模糊PID控制器中,输出为铰接角的变化量Δδ1;

同样的,将计算出的后桥的位置偏差dr与后桥的航向偏差 输入到模糊PID控制器中,输出为铰接角的变化量Δδ2;

将求出的铰接角变化量Δδ1和Δδ2进行加权求和,根据以下计算公式,得到铰接角的变化量Δδ:步骤S8,对车辆进行转向控制,控制车辆到达下一采样时刻时,重复步骤S2‑S7。

2.根据权利要求1所述的铰接式车辆路径跟踪控制方法,其特征在于,所述步骤S4中搜索的点至少为六个点。

3.根据权利要求1所述的铰接式车辆路径跟踪控制方法,其特征在于,所述路径跟踪控制器包括模糊推理模块、PID控制器和执行机构,所述模糊推理模块用于粗略推理计算后的误差,所述PID控制器通过算法进行统计分析并得出准确参考路径;所述执行机构用于根据PID控制器得出参考路径控制车辆行驶。

4.根据权利要求3所述的铰接式车辆路径跟踪控制方法,其特征在于,所述路径跟踪控制器还包括权重分配模块,所述权重分配模块用于分配前桥的预瞄误差、航向误差与后桥的位置误差和航向误差在总误差中所占权重。