CN112859853A - 考虑时延和环境约束的智能收获机器人路径控制方法 - Google Patents
考虑时延和环境约束的智能收获机器人路径控制方法 Download PDFInfo
- Publication number
- CN112859853A CN112859853A CN202110025737.9A CN202110025737A CN112859853A CN 112859853 A CN112859853 A CN 112859853A CN 202110025737 A CN202110025737 A CN 202110025737A CN 112859853 A CN112859853 A CN 112859853A
- Authority
- CN
- China
- Prior art keywords
- harvester
- time delay
- input
- delay
- model
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 46
- 230000007613 environmental effect Effects 0.000 title claims abstract description 15
- 238000003306 harvesting Methods 0.000 title claims abstract description 15
- 238000006243 chemical reaction Methods 0.000 claims abstract description 12
- 230000001133 acceleration Effects 0.000 claims description 12
- 239000000126 substance Substances 0.000 claims description 6
- CLOMYZFHNHFSIQ-UHFFFAOYSA-N clonixin Chemical group CC1=C(Cl)C=CC=C1NC1=NC=CC=C1C(O)=O CLOMYZFHNHFSIQ-UHFFFAOYSA-N 0.000 claims description 3
- 238000012886 linear function Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 abstract description 3
- 238000012271 agricultural production Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000001934 delay Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A40/00—Adaptation technologies in agriculture, forestry, livestock or agroalimentary production
- Y02A40/10—Adaptation technologies in agriculture, forestry, livestock or agroalimentary production in agriculture
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种考虑时延和环境约束的智能收获机器人路径控制方法,属于现代农业无人辅助驾驶技术领域。本发明包括以下步骤:建立收获机转向系统的动力学模型、运动学模型、收获机‑地面受力模型,并构建考虑输入延迟和外部扰动的控制系统模型,将综合误差作为状态变量;基于预设性能函数对状态变量进行约束,通过误差转换函数将有约束的变量转换为无约束的变量;针对定常输入时延和时变输入时延两种情况,分别构建基于定常时延和基于时变时延估计值的饱和补偿变量,并基于反步法和李雅普诺夫稳定性定理设计相应的控制输入。此种方法可有效对跟踪误差进行约束,补偿输入时延对跟踪系统的影响,以提高收获机的自动驾驶导航效果。
Description
技术领域
本发明属于现代农业无人辅助驾驶技术领域,具体涉及一种考虑时延和环境约束的智能收获机器人路径控制方法。
背景技术
收获机辅助驾驶系统受控制信号传输及转向机构动作执行的影响,会产生时滞现象,降低控制系统的稳定性和动态性能,影响收获机辅助驾驶系统控制精度和工作效率,限制农业生产效率甚至损坏收获机。目前用于收获机的跟踪控制方法主要有PID控制、纯跟踪控制、模糊控制、模型预测控制等,或通过两种或多种方法的联合设计进行参数优化、增强鲁棒性等。前几种算法都没有考虑时滞对路径跟踪控制系统的影响,而模型预测控制具有预测功能,即能够根据系统的当前时刻的控制输入以及过去的历史信息,对未来控制输入进行提前预测,可对收获机的滞后进行一定的补偿,但其计算最优值时所需计算成本较高。本专利基于反步法和李雅普诺夫稳定性定理设计了考虑定常时延补偿和时变时延补偿的控制方法。
通常情况下,收获机辅助驾驶作业过程中,不仅要求闭环系统的稳定运行,还要求控制性能满足一定动态性能指标要求,这就需要在进行控制器设计时,既能够保证系统稳定,又要对系统输出的性能进行约束,即预设性能约束。目前,针对收获机路径跟踪控制系统同时考虑输入延迟和预设性能约束的情况研究较少,需开展收获机控制系统中考虑输入时延和扰动的研究,通过分析预设性能约束、定常输入时延补偿变量、时变时延补偿变量,提高收获机路径跟踪的效果。
发明内容
为解决上述问题,本发明公开了考虑时延和环境约束的智能收获机器人路径控制方法,可有效对跟踪误差进行约束,补偿输入时延对跟踪系统的影响,以提高收获机的自动驾驶导航效果。
为达到上述目的,本发明的技术方案如下:
考虑时延和环境约束的智能收获机器人路径控制方法,包括以下步骤:
步骤一,建立收获机转向系统的动力学模型、运动学模型、收获机-地面受力模型,并构建考虑输入延迟和外部扰动的控制系统模型;
步骤二,基于预设性能函数对状态变量进行约束,并通过误差转换函数将有约束的变量转换为无约束的变量;
步骤三,基于反步法和李雅普诺夫定理设计考虑定常时延的路径跟踪控制输入;
步骤四,基于反步法和李雅普诺夫定理设计考虑时变时延的路径跟踪控制输入。
进一步的,步骤一所述的建立收获机转向系统的动力学模型、运动学模型、收获机-地面受力模型,并构建考虑输入延迟和外部扰动的系统模型,其具体方法如下:
(2)建立收获机转向系统的动力学模型为
式中,ψ是航向角,Jz是转动惯量,lf和lr分别是前、后轴到质心的距离,Fyf、Fyr分别是前、后轮胎受到的侧向力。
(3)构建收获机的运动学模型:
求取当前时刻收获机的横向位置偏差的导数
设计一个考虑航向角偏差和横向位置偏差的综合偏差
ec=e+xcsin(Δψ);其中xc是误差权重系数;
(4)建立收获机-地面的受力模型:
在小角度假设情况下,前、后轮胎的侧偏角为
式中,δr为收获机后轮转向角,即要设计的控制输入量。
在侧偏角及纵向滑移率较小时,轮胎力可以用线性函数近似描述,前、后轮胎受到的侧向力为
式中,Cf、Cr分别为前、后轮胎的侧偏刚度,μ为路面摩擦系数。
(5)根据上面的收获机动力学模型、运动学模型和收获机-地面受力模型,可计算收获机的系统模型
考虑收获机的路径跟踪控制系统会受到输入延迟和外部扰动的影响,收获机的系统模型可表示为
进一步的,步骤二所述的基于预设性能函数对状态变量进行约束,并通过误差转换函数对其转换,其具体方法如下:
采用预测性能函数对状态变量x1进行约束
-ρ<x1<ρ
式中,ρ是预设性能函数,ρ=(ρ0-ρ∞)exp-lt+ρ∞,ρ0是初始误差的界定值,ρ∞是稳态误差的最大值,收敛速率系数为l。
通过误差转换将带有约束的误差x1转换为无约束的误差ε
ε=T(ρ-1x1)
误差ε的导数为
进一步的,步骤三所述的基于反步法和李雅普诺夫稳定性定理设计考虑定常时延的路径跟踪控制输入,其具体方法如下:
选取李雅普诺夫函数为
求取V1导数为
设计虚拟控制器为
式中,kc1是正常数。
令zc1=αc1-x2,则
为了补偿定常输入时延对系统的影响,设计一个辅助状态量r1
式中,kc2是正常数。
设计考虑定常输入延迟情况下的控制输入为
进一步的,步骤四所述的基于反步法和李雅普诺夫稳定性定理设计考虑时变时延的路径跟踪控制输入,其具体方法如下:
设计虚拟控制器为
式中,kc3是正常数。
为了补偿时变输入时延对系统的影响,基于时延估计值设计一个辅助状态量r2
设计考虑时变输入时延情况下的控制输入为
式中,ku2是正常数。
本发明的有益效果是:
1、本发明提供一种考虑时延和环境约束的智能收获机器人路径控制方法,能够有效补偿由于输入延迟降低路径跟踪性能的问题。
2、本发明提供一种考虑时延和环境约束的智能收获机器人路径控制方法,能够对跟踪误差进行预设约束,保证跟踪系统的动态性能和稳态性能。
附图说明
图1考虑输入延迟和预设性能约束的收获机路径跟踪控制方法流程图。
图2收获机路径跟踪数学模型示意图。
图3考虑扰动时的路径跟踪控制输入。
具体实施方式
下面结合附图和具体实施方式,进一步阐明本发明,应理解下述具体实施方式仅用于说明本发明而不用于限制本发明的范围。
为了补偿输入时延和外部扰动对收获机路径跟踪控制系统的影响,本发明提出一种考虑时延和环境约束的智能收获机器人路径控制方法。基于收获机路径跟踪的模型(如图2所示),建立收获机转向系统的动力学模型、运动学模型、收获机-地面受力模型,并构建考虑输入延迟和外部扰动的控制系统模型,将综合误差作为状态变量;基于预设性能函数对状态变量进行约束,并通过误差转换函数将有约束的变量转换为无约束的变量;基于反步法和李雅普诺夫稳定性定理设计考虑定常输时延的路径跟踪控制输入;基于反步法和李雅普诺夫稳定性定理设计考虑时变时延的路径跟踪控制输入。此种方法可用于补偿定常输入延迟和时变输入延迟两种情况下的路径跟踪控制,保证路径跟踪的动态性能和稳态性能。
步骤一,建立收获机转向系统的动力学模型、运动学模型、收获机-地面受力模型,并构建考虑输入时延和外部扰动的系统模型,具体方法如下:
(2)建立收获机转向系统的动力学模型为
式中,ψ是航向角,Jz是转动惯量,lf和lr分别是前、后轴到质心的距离,Fyf、Fyr分别是前、后轮胎受到的侧向力。
(3)构建收获机的运动学模型
求取当前时刻收获机的横向位置偏差的导数
设计一个考虑航向角偏差和横向位置偏差的综合偏差
ec=e+xcsin(Δψ);其中xc是误差权重系数;
(4)建立收获机-地面的受力模型
在小角度假设情况下,前、后轮胎的侧偏角为
式中,δr为收获机后轮转向角,即要设计的控制输入量。
在侧偏角及纵向滑移率较小时,轮胎力可以用线性函数近似描述,前、后轮胎受到的侧向力为
式中,Cf、Cr分别为前、后轮胎的侧偏刚度,μ为路面摩擦系数。
(5)根据上面的收获机动力学模型、运动学模型和收获机-地面受力模型,可计算收获机的系统模型
考虑收获机的路径跟踪控制系统会受到输入延迟和外部扰动的影响,收获机的系统模型可表示为
步骤二,基于预设性能函数对状态变量进行约束,并通过误差转换函数对其转换,具体方法如下:
采用预测性能函数对状态变量x1进行约束
-ρ<x1<ρ,式中,ρ是预设性能函数,ρ=(ρ0-ρ∞)exp-lt+ρ∞,ρ0是初始误差的界定值,ρ∞是稳态误差的最大值,收敛速率系数为l。
通过误差转换将带有约束的误差x1转换为无约束的误差ε
ε=T(ρ-1x1)
误差ε的导数为
步骤三,基于反步法和李雅普诺夫稳定性定理设计考虑定常时延的路径跟踪控制输入,具体方法如下:
选取李雅普诺夫函数为
求取V1导数为
设计虚拟控制器为
式中,kc1是正常数。
令zc1=αc1-x2,则
为了补偿定常输入时延对系统的影响,设计一个辅助状态量r1
式中,kc2是正常数。
设计考虑定常输入时延情况下的控制输入为
步骤四,基于反步法和李雅普诺夫稳定性定理设计考虑未知时延的路径跟踪控制输入,具体方法如下:
设计虚拟控制器为
式中,kc3是正常数。为了补偿时变输入延迟对系统的影响,基于时延估计值设计一个辅助状态量r2
设计考虑时变输入时延情况下的控制输入为
式中,ku2是正常数。
本发明提出的一种考虑时延和环境约束的智能收获机器人路径控制方法,可有效补偿定常输入时延和时变输入时延两种情况下的路径跟踪系统,并利用预设性能对跟踪误差进行约束,有效保证了路径跟踪的动态性能和稳态性能。所设计的预设性能约束能够有效抑制外界扰动对路径跟踪的影响,保证跟踪变量的动态性能和稳态性能;输入时延补偿变量对路径跟踪的平稳性有了很大提高。
Claims (5)
1.考虑时延和环境约束的智能收获机器人路径控制方法,其特征在于,包括以下步骤:
步骤一,建立收获机转向系统的动力学模型、运动学模型、收获机-地面受力模型,并构建考虑输入延迟和外部扰动的控制系统模型;
步骤二,基于预设性能函数对状态变量进行约束,并通过误差转换函数将有约束的变量转换为无约束的变量;
步骤三,基于反步法和李雅普诺夫定理设计考虑定常时延的路径跟踪控制输入;
步骤四,基于反步法和李雅普诺夫定理设计考虑时变时延的路径跟踪控制输入。
2.根据权利要求1所述的考虑时延和环境约束的智能收获机器人路径控制方法,其特征在于,步骤一的具体方法如下:
(2)建立收获机转向系统的动力学模型为
式中,ψ是航向角,Jz是转动惯量,lf和lr分别是前、后轴到质心的距离,Fyf、Fyr分别是前、后轮胎受到的侧向力;
(3)构建收获机的运动学模型
求取当前时刻收获机的横向位置偏差的导数
设计一个考虑航向角偏差和横向位置偏差的综合偏差
ec=e+xcsin(Δψ);其中xc是误差权重系数;
(4)建立收获机-地面的受力模型:
在小角度假设情况下,前、后轮胎的侧偏角为
式中,δr为收获机后轮转向角,即要设计的控制输入;
在侧偏角及纵向滑移率较小时,轮胎力用线性函数近似描述,前、后轮胎受到的侧向力为
式中,Cf、Cr分别为前、后轮胎的侧偏刚度,μ为路面摩擦系数;
(5)根据上面的收获机动力学模型、运动学模型和收获机-地面受力模型,计算收获机的系统模型
考虑收获机的路径跟踪控制系统会受到输入延迟和外部扰动的影响,收获机的系统模型表示为
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110025737.9A CN112859853B (zh) | 2021-01-08 | 2021-01-08 | 考虑时延和环境约束的智能收获机器人路径控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110025737.9A CN112859853B (zh) | 2021-01-08 | 2021-01-08 | 考虑时延和环境约束的智能收获机器人路径控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112859853A true CN112859853A (zh) | 2021-05-28 |
CN112859853B CN112859853B (zh) | 2022-07-12 |
Family
ID=76001844
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110025737.9A Active CN112859853B (zh) | 2021-01-08 | 2021-01-08 | 考虑时延和环境约束的智能收获机器人路径控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112859853B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114347031A (zh) * | 2022-01-18 | 2022-04-15 | 广东省智能机器人研究院 | 一种考虑时变时滞的移动机械臂避碰控制方法及装置 |
WO2023124735A1 (zh) * | 2021-12-31 | 2023-07-06 | 广东美的白色家电技术创新中心有限公司 | 机器人控制方法、装置、系统及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100241289A1 (en) * | 2006-06-22 | 2010-09-23 | Roy Sandberg | Method and apparatus for path planning, selection, and visualization |
CN103576693A (zh) * | 2013-11-11 | 2014-02-12 | 哈尔滨工程大学 | 基于二阶滤波器的水下机器人三维路径跟踪控制方法 |
CN108614560A (zh) * | 2018-05-31 | 2018-10-02 | 浙江工业大学 | 一种移动机器人视觉伺服保性能跟踪控制方法 |
CN108803601A (zh) * | 2018-05-31 | 2018-11-13 | 浙江工业大学 | 一种具有通信约束的移动机器人鲁棒预测跟踪控制方法 |
CN110865539A (zh) * | 2019-11-18 | 2020-03-06 | 华南理工大学 | 一种随机干扰下的无人艇跟踪误差约束控制方法 |
CN111781945A (zh) * | 2020-06-09 | 2020-10-16 | 南京邮电大学 | 具有随机时延的多智能体编队控制方法 |
-
2021
- 2021-01-08 CN CN202110025737.9A patent/CN112859853B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100241289A1 (en) * | 2006-06-22 | 2010-09-23 | Roy Sandberg | Method and apparatus for path planning, selection, and visualization |
CN103576693A (zh) * | 2013-11-11 | 2014-02-12 | 哈尔滨工程大学 | 基于二阶滤波器的水下机器人三维路径跟踪控制方法 |
CN108614560A (zh) * | 2018-05-31 | 2018-10-02 | 浙江工业大学 | 一种移动机器人视觉伺服保性能跟踪控制方法 |
CN108803601A (zh) * | 2018-05-31 | 2018-11-13 | 浙江工业大学 | 一种具有通信约束的移动机器人鲁棒预测跟踪控制方法 |
CN110865539A (zh) * | 2019-11-18 | 2020-03-06 | 华南理工大学 | 一种随机干扰下的无人艇跟踪误差约束控制方法 |
CN111781945A (zh) * | 2020-06-09 | 2020-10-16 | 南京邮电大学 | 具有随机时延的多智能体编队控制方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023124735A1 (zh) * | 2021-12-31 | 2023-07-06 | 广东美的白色家电技术创新中心有限公司 | 机器人控制方法、装置、系统及存储介质 |
CN114347031A (zh) * | 2022-01-18 | 2022-04-15 | 广东省智能机器人研究院 | 一种考虑时变时滞的移动机械臂避碰控制方法及装置 |
CN114347031B (zh) * | 2022-01-18 | 2024-01-16 | 广东省智能机器人研究院 | 一种考虑时变时滞的移动机械臂避碰控制方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN112859853B (zh) | 2022-07-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109795502B (zh) | 智能电动汽车路径跟踪模型预测控制方法 | |
CN109144076B (zh) | 一种多车辆横纵向耦合协同控制系统及控制方法 | |
CN111240187B (zh) | 一种基于车辆误差模型的车辆轨迹跟踪控制算法 | |
CN112622903B (zh) | 一种车辆跟随驾驶环境下自主车辆的纵向和横向控制方法 | |
CN112859853B (zh) | 考虑时延和环境约束的智能收获机器人路径控制方法 | |
CN112141101B (zh) | 一种基于cnn和lstm的预瞄安全路径的方法及系统 | |
CN111923908A (zh) | 一种融合稳定性的智能汽车路径跟踪控制方法 | |
CN111506099B (zh) | 一种无人机高度智能控制系统及方法 | |
CN113126623B (zh) | 一种考虑输入饱和的自适应动态滑模自动驾驶车辆路径跟踪控制方法 | |
CN112622895B (zh) | 一种应用于自动驾驶的轨迹控制的预估控制方法 | |
CN111123701B (zh) | 基于管道预测模型的自动驾驶路径跟踪抗干扰控制方法 | |
CN111679575B (zh) | 一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法 | |
CN113183957A (zh) | 车辆控制方法、装置、设备及自动驾驶车辆 | |
CN112606843A (zh) | 一种基于Lyapunov-MPC技术的智能车辆路径跟踪控制方法 | |
CN116552550A (zh) | 基于参数不确定性和横摆稳定性的车辆轨迹跟踪控制系统 | |
CN114684199A (zh) | 一种机理分析-数据驱动的车辆动力学串联混合模型、智能汽车轨迹跟踪控制方法及控制器 | |
CN112896494A (zh) | 基于模型预测控制的飞机防滑刹车控制方法 | |
CN114502450A (zh) | 机动车辆横向和纵向引导中的死区时间补偿技术 | |
CN116834754A (zh) | 一种自动驾驶车辆自适应调速的横纵协同控制方法 | |
CN116627036A (zh) | 一种基于智能轮胎技术的智能汽车泊车规划控制方法 | |
CN114148318B (zh) | 冰雪环境下基于反馈线性化与lqr的车辆路径跟踪方法 | |
CN115675459A (zh) | 一种智能车辆及其路径跟踪的控制方法、装置和存储介质 | |
Huang et al. | Cascade optimization control of unmanned vehicle path tracking under harsh driving conditions | |
CN115167135A (zh) | 反馈与模型前馈串级的无人驾驶车辆自趋优位姿控制系统 | |
CN115534970A (zh) | 对车辆的行驶动态调节系统进行最佳参数化的方法和装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
CB03 | Change of inventor or designer information |
Inventor after: Wang Lihui Inventor after: Zhang Yuexin Inventor before: Wang Lihui Inventor before: Zhang Yuexin Inventor before: Tang Zihan Inventor before: Zhou Yekang Inventor before: Zhang Hongkun Inventor before: Li Huijun |
|
CB03 | Change of inventor or designer information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |