一种基于最优化的AGV路径跟踪方法与流程

技术特征：
1.一种基于最优化的agv路径跟踪方法，其特征在于：其路径跟踪方法包括以下步骤：a、路径离散化为路径点：每个路径点包含当前点的位置和该点的期望偏航角，期望偏航角为该路径点所在曲线的切线角度，再计算出agv所在位姿的当前最近点，最后根据agv运行速度和目标时间计算出对应的最优化路径长度，输出从最近点到最优化路径长度内所有的路径点；b、最优化agv航向角：然后根据agv航向的角速度限制和角加速度限制求出待确定的agv航向角的取值范围，最后根据性能指标和限制条件求解最优化问题，从而获得路径跟踪的最优航向，最优化问题如下：其中，θ为待确认的agv航向角；n是路径点个数；d
i
是在agv航向角为θ时第i个路径点到车辆运行路径的最短距离；θ
i
是第i个路径点所在曲线的切线角度；θ
min
和θ
max
是agv航向角约束的上界和下界；w1和w2分别是距离误差和航向误差所占的权重；s.t.θ∈[θ
min θ
max
]c、航向控制：首先，使用一阶线性eso(扩张状态观测器)估计出被控对象的等效干扰和角速度值，eso的输入为被控对象的输入u(上一时刻命令航向角)和被控对象的输出y(实际角速度)；再根据eso观测的角速度和实际航向角和期望航向角设计pd控制律，最后根据eso观测的等效干扰前馈补偿系统的不确定性即得到当前期望的航向角；eso是扩展状态观测器，公式如下：eso是扩展状态观测器，公式如下：l1和l2是eso的参数，y是实际角速度，u是控制量，z1是角速度估计值，z2是干扰估计值。2.根据权利要求1所述的一种基于最优化的agv路径跟踪方法，其特征在于：把直线、圆弧等曲线统一写成贝塞尔曲线的形式以使所有路径在数学上的形式保持一致，把路径离散化为路径点。3.根据权利要求1所述的一种基于最优化的agv路径跟踪方法，其特征在于：根据路径生成路径点和当前位置以及待确定的agv航向角设计性能指标。4.根据权利要求1所述的一种基于最优化的agv路径跟踪方法，其特征在于：根据最优化输出的agv命令航向角，航向控制输出agv底盘的命令角速度，针对的agv载荷不同航向角特性不同的问题，控制算法的设计采用adrc实现命令航向角的跟踪和干扰抑制功能以实现精准控制。

技术总结
本发明公开了一种基于最优化的AGV路径跟踪方法，每个路径点包含当前点的位置和该点的期望偏航角，期望偏航角为该路径点所在曲线的切线角度，再计算出AGV所在位姿的当前最近点，最后根据AGV运行速度和目标时间计算出对应的路径长度，输出从最近点到路径长度内所有的路径点。本发明根据路径和车辆运行速度因素使用最优化工具实时在线调整车辆的横向控制律，以实现对路径跟踪的精准控制和对运行速度变化的鲁棒性；而且主要涉及AGV领域，主要作用是提高物流搬运、生产等环节AGV路径跟踪的精度，提高横向控制对针对路径变化的鲁棒性和针对车辆纵向速度变化的鲁棒性，同时该在线优化策略能根据实际情况进行调整，能实现最优的控制效果。果。果。


技术研发人员：邓超 蒋涛江
受保护的技术使用者：佛山市毕佳索智能科技有限公司
技术研发日：2021.11.29
技术公布日：2022/1/28