一种基于高速状态转换模型的AGV队列的避撞控制方法技术

本发明专利技术属于自动控制领域，具体涉及一种基于高速状态转换模型的AGV队列的避撞控制方法及其控制器。该方法包括如下步骤：S1：基于牛顿

【技术实现步骤摘要】
一种基于高速状态转换模型的AGV队列的避撞控制方法


[0001]本专利技术属于自动控制领域，具体涉及一种基于高速状态转换模型的AGV队列的避撞控制方法，以及对应的避撞控制器。

技术介绍

[0002]随着自动控制和人工智能的技术不断进步，各种无人车和无人机已经逐渐开始商业化应用，并取代人工完成部分传统的重复性劳动；例如无人机配送，和码头的AGV货运小车等。在这些领域中，前沿的技术是各类多智能体集群控制技术。
[0003]队列系统是多智能体集群控制中的一个分支。队列系统脱胎于多智能体系统，核心技术是纵向跟随技术，其目的是根据不同的编队要求和环境约束，将具有类似行驶特征的零散车辆变成一个队列行驶，或将零散车辆编入已有队列中行驶，或在车辆驶离、驶入队列后重新编组为新的队列系统。在过去的30年里已经取得了较为丰硕的成果，其应用可见于高速公路系统、工业AGV、智慧物流、军事领域。其关键技术包括车车通信(V2V)、路径规划、路径跟踪、稳定性控制等。
[0004]单个AGV系统本身就是一个由多个子系统构成的复杂系统，由多个AGV系统构成的AGV队列系统则更加复杂。尽管当前在队列系统的纵向控制方面已经有很多研究成果，但对高速率避撞相关研究仍然较少。一方面，现有技术对非完整约束尤其是不等式约束条件下的队列系统建模研究较少，且在建模时未将避撞条件嵌入到模型中；因而通常无法实现有效的全局避撞。另一方面，现有的研究大部分仅对AGV的动力学模型进行了简化处理，未能克服系统中存在的参数不确定性、外部干扰、通讯问题(如延迟、信息错误、数据丢失)等缺陷，这仍然能会对队列系统的稳定性造成巨大挑战；进而影响队列系统的控制精度和安全性。

技术实现思路

[0005]为了解决现有的AGV队列系统的控制精度不足，稳定性差，无法实现全局避撞的问题，本专利技术提供一种基于高速状态转换模型的AGV队列的避撞控制方法，以及对应的避撞控制器。
[0006]本专利技术采用以下技术方案实现：
[0007]一种基于高速状态转换模型的AGV队列的避撞控制方法，该避撞控制方法包括如下步骤：
[0008]S1：基于牛顿
‑
欧拉方法构建AGV队列系统的动力学模型。
[0009]S2：根据任意车辆与前车的实际车距S
i
和理想车距的偏差建立误差函数E
i
(t)，并构建避撞约束。
[0010]S3：定义Γ
i1
为一个与理想车距以及误差函数有关的第一状态参数，其对应的高速状态转换模型如下：
[0011][0012]S4：通过高速状态转换模型对误差函数进行转换，得到AGV队列系统的车间距动力学方程。
[0013]S5：结合所述动力学模型以及车间距动力学方程中的状态参数，构建一个满足全局避撞约束的自适应控制器，包括如下步骤：
[0014]S51：采用不确定系统分解方法，将AGV队列系统的动力学模型中的参数分解为确定性部分和不确定性部分。
[0015]S52：根据分解出的系统中的确定性部分设置线性控制项U
i1
和反馈项U i2
：
[0016][0017]上式中，和分别表示第i个车辆的动力学模型中行驶阻力F
i
和质量M
i
的确定性部分；Γ
i2
表示第二状态参数，表示第二状态参数，和分别为第一状态参数的二阶导数中误差函数的一阶系数和二阶系数；Γ
i3
表示第三状态参数；
[0018]S53：设置用于估计AGV队列系统中的不确定性参数α
i
的自适应率，进而确定系统不确定性的补偿项U
i3
：
[0019][0020]上式中，表示不确定性参数的估计值；表示不确定参数α
i
的估计函数；表示函数的补偿函数；表示与有关的调整系数；γ
i
表示求和函数项数。
[0021]S54：设计包含线性控制项U
i1
、反馈项U
i2
和补偿项U
i3
的自适应控制器；自适应控制器中的控制力输入U
i
为：
[0022]U
i
＝U
i1
+U
i2
+U
i3
。
[0023]S6：对采用自适应控制器的AGV队列系统进行稳定性验证，并利用经过验证的自适应控制器实现AGV队列系统的全局避障和稳定控制。
[0024]作为本专利技术进一步的改进，步骤S1中，任意车辆的动力学方程如下：
[0025][0026]上式中，t表示时间；χ
i
表示车辆的位移；σ
i
表示设计的不确定参数；U
i
表示控制力输入；M
i
表示第i辆车的质量；表示包括滚动阻力、加速阻力和其他外部干扰的行驶阻力的总和。
[0027]作为本专利技术进一步的改进，步骤S2中，在初始安全条件下，任意车辆i与前车不发生碰撞的充要条件为：
[0028][0029]上式中，表示第当前车辆i的前车的车身长度；
[0030]误差函数为：
[0031][0032]则AGV队列系统的避撞约束为：
[0033][0034]作为本专利技术进一步的改进，步骤S4中，AGV队列系统满足车辆避撞的二阶约束为：
[0035][0036]转换后的车间距动力学方程如下：
[0037][0038]作为本专利技术进一步的改进，步骤S5中，一阶系数、二阶系数和第三状态参数分别满足：
[0039][0040][0041][0042]作为本专利技术进一步的改进，在步骤S51AGV队列系统的动力学模型中，系统参数分解如下：
[0043][0044]上式中，和分别表示第i个车辆的行驶阻力和质量的确定性部分；ΔM
i
和ΔF
i
分别表示第i个车辆的行驶阻力和质量的不确定性部分。
[0045]作为本专利技术进一步的改进，步骤S52中，控制力输入中的反馈项U
i2
满足：
[0046][0047]上式中，β
i
为一个自适应反馈控制系数，且满足：
[0048][0049]作为本专利技术进一步的改进，步骤S53中，不确定性参数α
i
的自适应律为：
[0050][0051]上式中，k1表示偏微分系数；表示不确定参数估计值的估计函数：表示与第二状态参数相关的函数，k2表示估计值系数。
[0052]作为本专利技术进一步的改进，估计函数函数的补偿系数满足：
[0053][0054]本专利技术还包括一种AG队列系统的避撞控制器，其采用如前述的基于高速状态转换模型的AGV队列的避撞控制方法中设计的自适应控制器；避撞控制器用于快速实现AGV队列系统的队列成形和避撞控制。
[0055]本专利技术提供的技术方案，具有如下有本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于高速状态转换模型的AGV队列的避撞控制方法，其特征在于，所述避撞控制方法包括如下步骤：S1：基于牛顿
‑
欧拉方法构建AGV队列系统的动力学模型；S2：根据任意车辆与前车的实际车距S
i
和理想车距的偏差建立误差函数E
i
(t)，并构建避撞约束；S3：定义Γ
i1
为一个与理想车距以及误差函数有关的第一状态参数，其对应的高速状态转换模型如下：S4：通过所述高速状态转换模型对所述误差函数进行转换，得到AGV队列系统的车间距动力学方程；S5：结合所述动力学模型以及车间距动力学方程中的状态参数，构建一个满足全局避撞约束的自适应控制器，包括如下步骤：S51：采用不确定系统分解方法，将AGV队列系统的动力学模型中的参数分解为确定性部分和不确定性部分；S52：根据分解出的系统中的确定性部分设置线性控制项U
i1
和反馈项U
i2
：上式中，和分别表示第i个车辆的动力学模型中行驶阻力F
i
和质量M
i
的确定性部分；Γ
i2
表示第二状态参数，表示第二状态参数，和分别为第一状态参数的二阶导数中误差函数的一阶系数和二阶系数；Γ
i3
表示第三状态参数；S53：设置用于估计AGV队列系统中的不确定性参数α
i
的自适应率，进而确定系统不确定性的补偿项U
i3
：上式中，表示不确定性参数的估计值；表示不确定参数α
i
的估计函数；表示函数的补偿函数；表示与有关的调整系数；γ
i
表示求和函数项数；S54：设计包含线性控制项U
i1
、反馈项U
i2
和补偿项U
i3
的自适应控制器，所述自适应控制器中的控制力输入U
i
为：U
i
＝U
i1
+U
i2
+U
i3
；S6：对采用所述自适应控制器的AGV队列系统进行稳定性验证，并利用经过验证的自适应控制器实现AGV队列系统的全局避障和稳定控制。
2.如权利要求1所述的基于高速状态转换模型的AGV队列的避撞控制方法，其特征在于：步骤S1中，任意车辆的动力学方程如下：上...

【专利技术属性】
技术研发人员：赵晓敏，胡上弘，林育明，崔峥嵘，董方方，李斌鹤，潘畅，牛帅，
申请(专利权)人：合肥工业大学，
类型：发明
国别省市：