CN113985890B - 一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法 - Google Patents
一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN113985890B CN113985890B CN202111342908.7A CN202111342908A CN113985890B CN 113985890 B CN113985890 B CN 113985890B CN 202111342908 A CN202111342908 A CN 202111342908A CN 113985890 B CN113985890 B CN 113985890B
- Authority
- CN
- China
- Prior art keywords
- kinematic
- center
- neural network
- mobile robot
- robot
- 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.)
- Active
Links
- 238000013528 artificial neural network Methods 0.000 title claims abstract description 23
- 238000000034 method Methods 0.000 title claims abstract description 21
- 230000005484 gravity Effects 0.000 claims abstract description 11
- 230000003044 adaptive effect Effects 0.000 claims description 13
- 238000013461 design Methods 0.000 claims description 5
- 230000008859 change Effects 0.000 claims description 3
- 230000006870 function Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 4
- 238000005299 abrasion Methods 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
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
-
- 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/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法,包括以下步骤:步骤1、建立在轮式移动机器人重心与其驱动中心不重合的状态下,建立轮式移动机器人的运动学模型;步骤2、建立轨迹跟踪误差系统模型;步骤3、通过所建立的轨迹跟踪误差系统模型,设计运动学控制器打滑参数的自适应估计律;步骤4,通过神经网络方法,实现对运动学控制器在线整定,其结合机器人重心与其驱动中心不重合以及车轮存在打滑状态的情况下,通过神经网络的参数整定方法,实现了对参考轨迹的精准的快速跟踪。
Description
技术领域
本发明涉及机器人轨道跟踪技术领域,具体指一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法。
背景技术
随着机器人技术的不断发展,移动机器人在现实生活中的应用范围不断扩大。轨迹跟踪作为轮式移动机器人控制领域中的一个重要问题,得到了广泛的研究。反步法、自适应控制、滑模控制、扰动观测器等技术都可应用于轮式移动机器人的轨迹跟踪控制。
现有方法一般基于机器人重心与其驱动中心是重合的状态下,实现轮式机器人的轨迹跟踪。然而机器人重心与其驱动中心是重合的状态是一种理想状态。因此在现实中,由于机械设计、传感器装配、负载不均等因素,轮式移动机器人的重心与驱动中心往往是不重合的。因此,常规的轨迹跟踪方法往往会存在一些偏差,对与跟踪轨迹的精度有一定的影响。
另一方面,在大部分的研究中也都假设移动机器人在运动过程中车轮与地面之间满足纯滚动无滑动的条件,但由于路面结冰、湿滑、轮胎磨损以及快速转弯等因素都会导致移动机器人发生车轮打滑的情况,严重影响轮式机器人轨迹跟踪精度,甚至导致轮式移动机器人无法跟踪参考轨迹。
发明内容
本发明根据现有技术的不足,提出一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法,结合机器人重心与其驱动中心不重合以及车轮存在打滑状态的情况下,通过神经网络的参数整定方法,实现了对参考轨迹的精准的快速跟踪。
为了解决上述技术问题,本发明的技术方案为:
一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法,包括以下步骤:
步骤1、建立运动学模型
建立重心与其驱动中心不重合的状态下轮式移动机器人的运动学模型;
步骤2、建立轨迹跟踪误差系统模型;
步骤3、通过所建立的轨迹跟踪误差系统模型,设计运动学控制器打滑参数的自适应估计律;
步骤4,通过神经网络方法,实现对运动学控制器的控制参数进行在线整定。
作为优选,所述步骤1中,所述建立的运动学模型引入有针对左右轮打滑程度的打滑参数。
作为优选,所述步骤1中所建立的运动学模型为,
其中[x,y,θ]为轮式移动机器人的位姿,wL和wR为左、右轮的角速度,r为车轮半径,b为左、右驱动轮到驱动轮轴中心的距离,d为轮式移动机器人的质心到驱动轮轴中心的距离,ρL和ρR为左右轮的打滑参数。
作为优选,所述步骤2中,基于车轮打滑状态下建立的跟踪误差系统模型为:
其中:
上式中的xe、ye和θe为轮式移动机器人的轨迹误差,vr与wr为期望线速度与期望角速度,v为线速度,w为角速度。
作为优选,所述步骤3中,运动学控制器和打滑参数的自适应估计律的设计还基于李雅普诺夫函数,所述李雅普诺夫函数如下:
其中X、Y的表达式如下:
与/>分别为左右轮滑动参数的估计误差,设/>与/>分别为左右轮滑动参数的估计值。
作为优选,所述步骤3中设计的运动学控制器如下:
其中kx、ky、与kθ为控制器的控制参数。
作为优选,所述步骤3中设计的左、右轮滑动参数的自适应估计律如下:
上式中ηL、ηR为自适应增益。
作为优选,所述步骤4中使用神经网络对运动学控制器的控制参数进行在线调整的算法为:
上式中kx、ky、kθ为运动学控制器的控制参数,分别为kx、ky、kθ的变化率,tstep为每次进行控制参数更新的时间步长。
本发明具有以下的特点和有益效果:
采用上述技术方案,针对现实中轮式移动机器人重心与驱动中心不重合的情况,另外还引入车轮打滑参数,通过建立轮式移动机器人的运动学系统模型,设计了运动学控制器和打滑参数的自适应估计律,保证了跟踪误差能够收敛到0,从而大大提高了轨迹跟踪的精度,并通过神经网络对控制参数进行在线整定,提高了轮式移动机器人的轨迹跟踪速度以及轨迹跟踪的精度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例的原理图。
图2是本发明实施例中的运动学模型模型示意图。
图3是本发明实施例中轨迹跟踪误差示意图。
图4是本发明实施例中圆形轨迹的跟踪效果图。
图5是本发明实施例中神经网络结构图。
具体实施方式
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。
在本发明的描述中,需要理解的是,术语“中心”、“纵向”、“横向”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”等仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”等的特征可以明示或者隐含地包括一个或者更多个该特征。在本发明的描述中,除非另有说明,“多个”的含义是两个或两个以上。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以通过具体情况理解上述术语在本发明中的具体含义。
实施例1
本实施例提供了一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法,包括以下步骤:
步骤1、建立运动学模型
建立重心与其驱动中心不重合的状态下轮式移动机器人的运动学模型;
针对车轮打滑状态下的轮式移动机器人,引入描述左右轮打滑程度的打滑参数ρL和ρR,并建立运动学模型;
步骤2、建立轨迹跟踪误差系统模型;
步骤3、通过所建立的轨迹跟踪误差系统模型,设计运动学控制器打滑参数的自适应估计律;
步骤4,通过神经网络方法,实现对运动学控制器的控制参数kx,ky和kθ进行在线整定。
上述技术方案中,建立轮式移动机器人的运动学系统模型时,考虑了现实情况下存在机器人重心与其驱动中心不重合,从而大大提高了轨迹跟踪的精度,另外还引入车轮打滑参数,通过建立轮式移动机器人的运动学系统模型,设计了运动学控制器和打滑参数的自适应估计律,确保了跟踪误差能够收敛到0,并通过神经网络对控制参数进行在线整定,提高了轮式移动机器人的轨迹跟踪速度以及轨迹跟踪的精度。
具体的,如图2所示,所述步骤1中所建立的运动学模型为,
其中[x,y,θ]为轮式移动机器人的位姿,wL和wR为左、右轮的角速度,r为车轮半径,b为左、右驱动轮到驱动轮轴中心的距离,d为轮式移动机器人的质心到驱动轮轴中心的距离,ρL和ρR为左右轮的打滑参数。
可以理解的,上述技术方案中,通过在运动学模型定义了wL和wR为左、右轮的角速度,r为车轮半径,b为左、右驱动轮到驱动轮轴中心的距离,d为轮式移动机器人的质心到驱动轮轴中心的距离,从而解决了现实情况下存在机器人重心与其驱动中心不重合,从而大大提高了轨迹跟踪的精度。另外,在运动学模型中引入ρL和ρR为左右轮的打滑参数,通过建立轮式移动机器人的运动学系统模型,进一步的提高了轨迹跟踪的精度和效率。
进而再设计了运动学控制器和打滑参数的自适应估计律,确保了跟踪误差能够收敛到0。
具体的,打滑参数的表达式如下所示:
ρL=(1-iL)
ρR=(1-iR)
iL与iR为左、右轮的打滑率,表达式如下:
其中vR与vL为左、右轮相对地面的实际线速度,其表达式如下:
vL=rwLρL
vR=rwRρR
本发明的进一步设置,如图3所示,所述步骤2中,基于车轮打滑状态下建立的跟踪误差系统模型为:
其中:
上式中的xe、ye和θe为轮式移动机器人的轨迹误差,vr与wr为期望线速度与期望角速度,v为线速度,w为角速度。
上述技术方案中,在步骤1的基础上,在建立跟踪误差系统模型,进一步减小轨迹跟踪的误差,进而提高了轨迹跟踪的精度。
本发明的进一步设置,所述步骤3中,运动学控制器和打滑参数的自适应估计律的设计还基于李雅普诺夫函数,所述李雅普诺夫函数如下:
其中X、Y的表达式如下:
与/>分别为左右轮滑动参数的估计误差,设/>与/>分别为左右轮滑动参数的估计值。/>与/>的关系如下:
上述技术方案中,提出了通过李雅普诺夫函数,设计运动学控制器和打滑参数的自适应估计律,可以理解的,李雅普诺夫函数(Lyapunov function)是用来证明一动力系统或自治微分方程稳定性的函数。针对自治系统的李雅普诺夫定理,直接使用李雅普诺夫候选函数的特性,从而寻找一个系统平衡点附近的稳定性。从而提高了该运动学控制器和打滑参数的自适应估计律的稳定性。进而提高了轨迹跟踪的精度
具体的,所述步骤3中设计的运动学控制器如下:
其中kx、ky、与kθ为控制器的控制参数。
进一步的,所述步骤3中设计的左、右轮滑动参数的自适应估计律如下:
上式中ηL、ηR为自适应增益。的表达式如下:
本发明的进一步设置,如图5所示,所述步骤4中使用神经网络对运动学控制器的控制参数进行在线调整的算法为:
上式中kx、ky、kθ为运动学控制器的控制参数,分别为kx、ky、kθ的变化率,tstep为每次进行控制参数更新的时间步长。
上述技术方案中,通过神经网络的引入,从而对运动学控制器的控制参数不断进行在线的调整,从而确保了跟踪误差能够收敛到0,进而不断提高轨迹跟踪的精度。
具体的,的表达式如下:
其中ηx、ηy、ηθ代表学习率,且都大于0,的表达式如下:
其中:
实施例2
本实施例与实施例1的区别在于,本实施例公开了一种包括实施例1中所述基于神经网络的轮式机器人自适应轨迹跟踪控制方法的存储介质。
以上结合附图对本发明的实施方式作了详细说明,但本发明不限于所描述的实施方式。对于本领域的技术人员而言,在不脱离本发明原理和精神的情况下,对这些实施方式包括部件进行多种变化、修改、替换和变型,仍落入本发明的保护范围内。
Claims (2)
1.一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法,其特征在于,包括以下步骤:
步骤1、建立运动学模型
建立重心与其驱动中心不重合的状态下轮式移动机器人的运动学模型;
步骤2、建立轨迹跟踪误差系统模型;
步骤3、通过所建立的轨迹跟踪误差系统模型,设计运动学控制器与打滑参数的自适应估计律;
步骤4,通过神经网络方法,实现对运动学控制器的控制参数进行在线整定;
所述步骤1中所建立的运动学模型为,
其中[x,y,θ]为轮式移动机器人的位姿,wL和wR为左、右轮的角速度,r为车轮半径,b为左、右驱动轮到驱动轮轴中心的距离,d为轮式移动机器人的质心到驱动轮轴中心的距离,ρL和ρR为左右轮的打滑参数;
所述步骤2中,基于车轮打滑状态下建立的跟踪误差系统模型为:
其中:
上式中的xe、ye和θe为轮式移动机器人的轨迹误差,vr与wr为期望线速度与期望角速度,v为线速度,w为角速度;
所述步骤3中,运动学控制器和打滑参数的自适应估计律的设计还基于李雅普诺夫函数,所述李雅普诺夫函数如下:
其中X、Y的表达式如下:
与/>分别为左右轮滑动参数的估计误差,设/>与/>分别为左右轮滑动参数的估计值;
所述步骤3中设计的运动学控制器如下:
其中kx、ky、与kθ为控制器的控制参数;
所述步骤3中设计的左、右轮滑动参数的自适应估计律如下:
上式中ηL、ηR为自适应增益;
所述步骤4中使用神经网络对运动学控制器的控制参数进行在线调整的算法为:
上式中kx、ky、kθ为运动学控制器的控制参数,分别为kx、ky、kθ的变化率,tstep为每次进行控制参数更新的时间步长。
2.根据权利要求1所述的基于神经网络的轮式机器人自适应轨迹跟踪控制方法,其特征在于,所述步骤1中,所述建立的运动学模型引入有针对左右轮打滑程度的打滑参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111342908.7A CN113985890B (zh) | 2021-11-12 | 2021-11-12 | 一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111342908.7A CN113985890B (zh) | 2021-11-12 | 2021-11-12 | 一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113985890A CN113985890A (zh) | 2022-01-28 |
CN113985890B true CN113985890B (zh) | 2024-04-12 |
Family
ID=79748318
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111342908.7A Active CN113985890B (zh) | 2021-11-12 | 2021-11-12 | 一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113985890B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114460945B (zh) * | 2022-02-14 | 2023-03-14 | 四川大学 | 移动机器人轨迹跟踪方法、装置及电子设备 |
CN116039636B (zh) * | 2022-12-15 | 2024-01-30 | 南通大学 | 考虑车轮打滑的轮式移动机器人自适应神经网络控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105629729A (zh) * | 2016-01-04 | 2016-06-01 | 浙江工业大学 | 一种基于线性自抗扰的网络化移动机器人轨迹跟踪控制方法 |
CN109031947A (zh) * | 2018-06-19 | 2018-12-18 | 哈尔滨理工大学 | 基于径向基神经网络的轨迹跟踪控制及方法 |
CN110597268A (zh) * | 2019-09-30 | 2019-12-20 | 东南大学 | 一种基于级联系统理论的轮式移动机器人轨迹跟踪控制方法 |
CN111950693A (zh) * | 2019-05-14 | 2020-11-17 | 辉达公司 | 使用衰减参数进行神经网络推理 |
-
2021
- 2021-11-12 CN CN202111342908.7A patent/CN113985890B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105629729A (zh) * | 2016-01-04 | 2016-06-01 | 浙江工业大学 | 一种基于线性自抗扰的网络化移动机器人轨迹跟踪控制方法 |
CN109031947A (zh) * | 2018-06-19 | 2018-12-18 | 哈尔滨理工大学 | 基于径向基神经网络的轨迹跟踪控制及方法 |
CN111950693A (zh) * | 2019-05-14 | 2020-11-17 | 辉达公司 | 使用衰减参数进行神经网络推理 |
CN110597268A (zh) * | 2019-09-30 | 2019-12-20 | 东南大学 | 一种基于级联系统理论的轮式移动机器人轨迹跟踪控制方法 |
Non-Patent Citations (1)
Title |
---|
移动机器人自适应神经滑模轨迹跟踪控制;宋立业;邢飞;;控制工程;20181120(第11期);第40-48页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113985890A (zh) | 2022-01-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113985890B (zh) | 一种基于神经网络的轮式机器人自适应轨迹跟踪控制方法 | |
US8983708B2 (en) | Steering control device of autonomous vehicle, autonomous vehicle having the same and steering control method of autonomous vehicle | |
CN109857100B (zh) | 一种基于反演法和快速终端滑模的复合轨迹跟踪控制算法 | |
CN111158379B (zh) | 一种方向盘零偏自学习的无人车轨迹跟踪方法 | |
CN109940596A (zh) | 一种基于方差的机器人位移补偿方法 | |
CN113126623B (zh) | 一种考虑输入饱和的自适应动态滑模自动驾驶车辆路径跟踪控制方法 | |
WO2021098663A1 (zh) | 一种四轮独立转向-独立驱动车辆轨迹跟踪方法和系统 | |
CN110109363B (zh) | 一种轮式移动机器人编队的神经网络自适应控制方法 | |
CN109292018B (zh) | 基于同轴式轮腿结构的四轮转向轨迹跟踪控制方法 | |
CN111845755B (zh) | 一种车辆纵向车速估计方法 | |
Wang et al. | Adaptive neural network sliding mode control for steer-by-wire-based vehicle stability control | |
CN111399500A (zh) | 一种两轮自平衡车集中式编队控制方法 | |
CN113211438A (zh) | 基于预瞄距离自适应的轮式机器人控制方法及控制系统 | |
Hill et al. | Online gain setting method for path tracking using CMA-ES: Application to off-road mobile robot control | |
CN116039636B (zh) | 考虑车轮打滑的轮式移动机器人自适应神经网络控制方法 | |
CN112287289A (zh) | 一种面向云控智能底盘的车辆非线性状态融合估计方法 | |
CN113650621B (zh) | 面向复杂工况的分布式驱动电动汽车状态参数估计方法 | |
CN114488790B (zh) | 一种基于名义模型的全向移动机器人自适应滑膜控制方法 | |
CN114740845A (zh) | 一种基于浸入与不变流形车辆跟踪控制方法 | |
CN113325849A (zh) | 一种针对高地隙植保机的运动控制方法 | |
CN113511188A (zh) | 车辆横向控制的方法、装置、电子设备及存储介质 | |
CN117807703B (zh) | 一种动静态参数互校正的滑板底盘车辆关键参数估计方法 | |
CN114896694B (zh) | 一种基于两点预瞄的路径跟踪控制方法 | |
CN117519190B (zh) | 一种新的铰接车辆控制方法 | |
CN115840368A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |