当前位置: 首页 > 专利查询>天津大学专利>正文

一种基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法技术

技术编号:40329527 阅读:20 留言:0更新日期:2024-02-09 14:22
本发明专利技术公开了一种基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法,包括以下步骤,根据无人驾驶采棉机的目标行驶轨迹,计算无人驾驶采棉机的距离误差与航向误差,获取预瞄点坐标;建立车辆的误差运动学模型,通过车辆的误差运动学模型,引入距离误差扰动和航向误差扰动,建立总扰动观测器,从而估计无人驾驶采棉机的系统总扰动;模型预测控制器根据距离误差、航向误差及系统总扰动计算反馈控制量;TD微分跟踪器根据预瞄点坐标计算前馈控制量;将反馈控制量及前馈控制量相加得到总控制量,再乘以控制器增益,得到目标方向盘转角,并发送给方向盘转角控制器,进行闭环控制。本发明专利技术拥有较好的控制综合性能。

【技术实现步骤摘要】

本专利技术涉及无人驾驶,特别是涉及一种基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法


技术介绍

1、棉花作为世界上最重要的经济作物之一,在全球范围内广泛种植。然而,大面积棉花的采收工作往往需要较高的人工成本,且经验不足的驾驶员由于车速与方向控制不合理,还可能导致采棉头堵塞与采棉机压棉等问题。因此,能对目标采收行驶轨迹进行准确跟踪的无人驾驶采棉机,对于提高采棉作业的质量与效率具有巨大潜力。

2、为此,上海大学的苗中华等人便运用速度参数自适应的比例-积分-微分(pid)控制算法,对采棉机的自动对行辅助驾驶控制技术展开了研究。然而由于车辆的状态随时间变化,并且道路条件具有不确定性,pid控制器难以在不同条件下保持最佳的控制品质,且未能推广到采棉机转向的循迹控制。为此,具有更好适应性和控制精度的基于模型的轨迹跟踪控制算法得到了广泛的研究。在传统的乘用车领域,预瞄法、模型预测控制、自适应控制等算法被广泛研究。有学者运用纯跟踪法设计了轨迹跟踪控制器,其结果表明,该算法在曲率较小的路径跟踪效果较好,而在曲率较大的路段由于预瞄点越过部分点,会造本文档来自技高网...

【技术保护点】

1.一种基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法,其特征在于,包括以下步骤:

2.如权利要求1所述的基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法,其特征在于,所述步骤1中,使用二分法找到目标轨迹上与当前实际位置最近的点,计算无人驾驶采棉机的距离误差ed与航向误差eθ,并同时以定位中心为圆心,预瞄距离为半径,找车辆前进方向上与目标轨迹的交点作为预瞄点。

3.如权利要求1所述的基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法,其特征在于,所述步骤2中,自行车运动学模型为:

4.如权利要求1所述的基于总扰动即时...

【技术特征摘要】

1.一种基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法,其特征在于,包括以下步骤:

2.如权利要求1所述的基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法,其特征在于,所述步骤1中,使用二分法找到目标轨迹上与当前实际位置最近的点,计算无人驾驶采棉机的距离误差ed与航向误差eθ,并同时以定位中心为圆心,预瞄距离为半径,找车辆前进方向上与目标轨迹的交点作为预瞄点。

3.如权利要求1所述的基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法,其特征在于,所述步骤2中,自行车运动学模型为:

4.如权利要求1所述的基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法,其特征在于,所述步骤2中,车辆的误差运动学模型:

5.如权利要求1所述的基于总扰动即时观测与模型预测的无人驾驶采棉机轨迹跟踪控制方法,其特征在于,所述步骤3中,总扰动观测器为:

6.如权利要求1所述的基于总扰动即时观测与模型预测的无人驾驶采棉机...

【专利技术属性】
技术研发人员:宋康刘国辰张连会刘志强谢辉
申请(专利权)人:天津大学
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1