CN109746922A - 一种基于有限时间切换控制的非完整机器人控制方法 - Google Patents
一种基于有限时间切换控制的非完整机器人控制方法 Download PDFInfo
- Publication number
- CN109746922A CN109746922A CN201910179184.5A CN201910179184A CN109746922A CN 109746922 A CN109746922 A CN 109746922A CN 201910179184 A CN201910179184 A CN 201910179184A CN 109746922 A CN109746922 A CN 109746922A
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- nonholonomic
- finite time
- target
- formula
- 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.)
- Pending
Links
Abstract
本发明公开了一种基于有限时间切换的非完整机器人控制方法,跟踪控制过程分为以下几步:(1)利用极坐标来刻画非完整机器人与移动目标在平面的距离以及方位角;(2)在极坐标下基于坐标变换将跟踪模型转换成误差模型,并在非完整机器人车身安装一台传感器,用于时时传输其与移动目标之间之间距离以及方位角;(3)传感器时时采集到的位置数据传输到有限时间控制算法模块中,使得非完整机器人时时调整自己的运动从而以既定的跟踪距离与零方位角跟踪移动目标。本发明的一种基于有限时间切换的非完整机器人控制算法纯几何运算、简单易懂、算法稳定,对硬件设备要求较低,跟踪稳定,实用性强,易于商业化。
Description
技术领域
本发明涉及非完整机器人运动控制技术领域,具体涉及一种基于有限时间切换控制的控制方法。
背景技术
目前非完整机器人的应用几乎渗透各行各业。非完整机器人具有自量轻、承载大、驱动和控制相对方便、行走速度快、工作效率高等优点,从而从各类机器人中脱颖而出。
利用非完整机器人解决跟踪移动目标的问题是一项具有挑战性的任务,在控制领域引起了越来越多的关注。跟踪运动目标有其自身的复杂性,主要表现在:目标运动更加多样化,密度更大,杂波密度更大。使用非完整机器人跟踪地面移动目标一直是最受关注的前沿课题之一。因为它在协作机器人侦察,多机器人形成和轨迹跟踪中有非常重要的应用。无人机(UAR)和无人地面机器人(UGR)通常用于跟踪移动目标。目前针对非完整机器人的控制算法大致有两种:(1)自适应控制,(2)鲁棒控制;但是这些算法计算复杂、计算量大、对系统的实时性要求高,这将增加算法实现成本,不利于实际应用。
因此,未解决上述问题,需要提出一种计算量小、实时性好、成本低,利用实际应用的非完整机器人跟踪控制方法。
发明内容
本发明的目的是为了解决现有非完整机器人控制技术中的上述缺陷,提供一种基于有限时间切换控制的非完整机器人控制方法,该方法计算量小、实时性好,实现成本低、便于实际应用。
本发明通过采取如下技术方案得到:
一种基于有限时间切换的非完整机器人控制方法,包括下列步骤:
(1)、利用极坐标来刻画非完整机器人与移动目标在平面的距离以及方位角;非完整机器人的运动学模型、移动目标运动模型和两者位置关系由公式(1)得到:
公式(1)中,[x,y]T∈R2代表非完整机器人在平面XOY中的位置坐标,θ为机器人前进的速度方向与X轴正向的夹角,v表示其前进直线速度,w表示其自转的角速度;[xt,yt]T∈R2代表移动目标在平面XOY中的位置坐标,vx和vy分别代表移动目标在平面中前进速度在X轴和Y轴上的分量速度;d代表非完整机器人与移动目标之间的直线距离,σ代表非完整机器人与移动目标之间的方位角;
(2)、在极坐标下基于坐标变换将跟踪模型转换成误差模型,并在非完整机器人车身安装一台传感器,用于实时传输其与移动目标之间距离以及方位角;
误差模型由公式(2)给出:
公式(2)中,X和Y分别是非完整机器人与移动目标的水平距离与竖直方向距离的坐标变换后的误差变量;σ+θ-β=π,d和σ关于时间的导数得到如下公式(3)的形式:
(3)、针对步骤(2)中的的误差模型设计有限时间切换控制器,有限时间切换控制器的步骤分为以下三步:
(3-1)、有限时间切换控制器第一模块设计为:
公式(4)中,κ1和ζ1满足0≤ζ1≤1,根据李雅普诺夫稳定性理论得到在有限时间内σ将收敛到0;
(3-2)、有限时间切换控制器第二模块设计为:
公式(5)中,κ2和ζ2满足0≤ζ2≤1,根据李雅普诺夫稳定性理论得到d随着时间不断衰减,为了避免非完整机器人和移动目标相碰撞,应当使d收敛到一个既定的理想跟踪距离dρ,因此考虑以下两种情况:
情况一、如果|d-dρ|<ε1,其中ε1是一个任意的正数,则进入步骤(3-3);
情况二、如果存在一个正数ε2使得|d-dρ|>ε2,那么重新进入步骤(3-2),直到满足情况一再进入步骤(3-3);
(3-3)、有限时间切换控制器第二模块设计为:
在此控制器下,能够保证σ和|d-dρ|一直保持在零的邻域内,至此整个非完整机器人跟踪移动目标的有限时间切换控制器设计完成;
将传感器实时采集到的位置数据传输到有限时间切换控制器中,使得非完整机器人实时调整自己的运动从而以既定的跟踪距离与零方位角跟踪移动目标。
上述的跟踪距离d应当收敛到既定的理想跟踪距离dρ。
本发明相对于现有控制技术具有以下的优点和效果:
本发明提出的非完整机器人控制算法基于极坐标采用几何直接推导获得,参数简单、物理含义清晰;非完整机器人控制算法中的计算是在跟踪控制开始前计算完成,跟踪过程无需人工干预,计算量小、实时性好,实现成本低、便于实际应用。
附图说明
图1是非完整机器人跟踪移动目标示意图。
具体实施方式
如图1所示,一种基于有限时间切换的非完整机器人控制方法,包括下列步骤:
(1)、利用极坐标来刻画非完整机器人与移动目标在平面的距离以及方位角;非完整机器人的运动学模型、移动目标运动模型和两者位置关系由公式(1)得到:
公式(1)中,[x,y]T∈R2代表非完整机器人在平面XOY中的位置坐标,θ为机器人前进的速度方向与X轴正向的夹角,v表示其前进直线速度,w表示其自转的角速度;[xt,yt]T∈R2代表移动目标在平面XOY中的位置坐标,vx和vy分别代表移动目标在平面中前进速度在X轴和Y轴上的分量速度;d代表非完整机器人与移动目标之间的直线距离,σ代表非完整机器人与移动目标之间的方位角;
(2)、在极坐标下基于坐标变换将跟踪模型转换成误差模型,并在非完整机器人车身安装一台传感器,用于实时传输其与移动目标之间距离以及方位角;
误差模型由公式(2)给出:
公式(2)中,X和Y分别是非完整机器人与移动目标的水平距离与竖直方向距离的坐标变换后的误差变量;根据图1可以得到σ+θ-β=π,d和σ关于时间的导数得到如下公式(3)的形式:
(3)、针对步骤(2)中的的误差模型设计有限时间切换控制器,有限时间切换控制器的步骤分为以下三步:
(3-1)、有限时间切换控制器第一模块设计为:
公式(4)中,κ1和ζ1满足0≤ζ1≤1,根据李雅普诺夫稳定性理论得到在有限时间内σ将收敛到0;
(3-2)、有限时间切换控制器第二模块设计为:
公式(5)中,κ2和ζ2满足0≤ζ2≤1,根据李雅普诺夫稳定性理论得到d随着时间不断衰减,为了避免非完整机器人和移动目标相碰撞,应当使d收敛到一个既定的理想跟踪距离dρ,因此考虑以下两种情况:
情况一、如果|d-dρ|<ε1,其中ε1是一个任意的正数,则进入步骤(3-3);
情况二、如果存在一个正数ε2使得|d-dρ|>ε2,那么重新进入步骤(3-2),直到满足情况一再进入步骤(3-3);
(3-3)、有限时间切换控制器第二模块设计为:
在此控制器下,能够保证σ和|d-dρ|一直保持在零的邻域内,至此整个非完整机器人跟踪移动目标的有限时间切换控制器设计完成;
将传感器实时采集到的位置数据传输到有限时间切换控制器中,使得非完整机器人实时调整自己的运动从而以既定的跟踪距离与零方位角跟踪移动目标。
上述的跟踪距离d应当收敛到既定的理想跟踪距离dρ。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (2)
1.一种基于有限时间切换的非完整机器人控制方法,其特征在于包括下列步骤:
(1)、利用极坐标来刻画非完整机器人与移动目标在平面的距离以及方位角;非完整机器人的运动学模型、移动目标运动模型和两者位置关系由公式(1)得到:
公式(1)中,[x,y]T∈R2代表非完整机器人在平面XOY中的位置坐标,θ为机器人前进的速度方向与X轴正向的夹角,v表示其前进直线速度,w表示其自转的角速度;[xt,yt]T∈R2代表移动目标在平面XOY中的位置坐标,vx和vy分别代表移动目标在平面中前进速度在X轴和Y轴上的分量速度;d代表非完整机器人与移动目标之间的直线距离,σ代表非完整机器人与移动目标之间的方位角;
(2)、在极坐标下基于坐标变换将跟踪模型转换成误差模型,并在非完整机器人车身安装一台传感器,用于实时传输其与移动目标之间距离以及方位角;
误差模型由公式(2)给出:
公式(2)中,X和Y分别是非完整机器人与移动目标的水平距离与竖直方向距离的坐标变换后的误差变量;σ+θ-β=π,d和σ关于时间的导数得到如下公式(3)的形式:
(3)、针对步骤(2)中的的误差模型设计有限时间切换控制器,有限时间切换控制器的步骤分为以下三步:
(3-1)、有限时间切换控制器第一模块设计为:
公式(4)中,κ1和ζ1满足0≤ζ1≤1,根据李雅普诺夫稳定性理论得到在有限时间内σ将收敛到0;
(3-2)、有限时间切换控制器第二模块设计为:
公式(5)中,κ2和ζ2满足0≤ζ2≤1,根据李雅普诺夫稳定性理论得到d随着时间不断衰减,为了避免非完整机器人和移动目标相碰撞,应当使d收敛到一个既定的理想跟踪距离dρ,因此考虑以下两种情况:
情况一、如果|d-dρ|<ε1,其中ε1是一个任意的正数,则进入步骤(3-3);
情况二、如果存在一个正数ε2使得|d-dρ|>ε2,那么重新进入步骤(3-2),直到满足情况一再进入步骤(3-3);
(3-3)、有限时间切换控制器第二模块设计为:
在此控制器下,能够保证σ和|d-dρ|一直保持在零的邻域内,至此整个非完整机器人跟踪移动目标的有限时间切换控制器设计完成;
将传感器实时采集到的位置数据传输到有限时间切换控制器中,使得非完整机器人实时调整自己的运动从而以既定的跟踪距离与零方位角跟踪移动目标。
2.根据权利要求1所述的一种基于有限时间切换控制的非完整机器人控制方法,其特征在于,所述的跟踪距离d应当收敛到既定的理想跟踪距离dρ。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910179184.5A CN109746922A (zh) | 2019-03-11 | 2019-03-11 | 一种基于有限时间切换控制的非完整机器人控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910179184.5A CN109746922A (zh) | 2019-03-11 | 2019-03-11 | 一种基于有限时间切换控制的非完整机器人控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109746922A true CN109746922A (zh) | 2019-05-14 |
Family
ID=66408367
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910179184.5A Pending CN109746922A (zh) | 2019-03-11 | 2019-03-11 | 一种基于有限时间切换控制的非完整机器人控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109746922A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111477003A (zh) * | 2020-04-13 | 2020-07-31 | 联陆智能交通科技(上海)有限公司 | 获取与弱势交通者相撞时间的计算方法和系统及介质 |
CN112907625A (zh) * | 2021-02-05 | 2021-06-04 | 齐鲁工业大学 | 应用于四足仿生机器人的目标跟随方法及系统 |
CN114211173A (zh) * | 2022-01-27 | 2022-03-22 | 上海电气集团股份有限公司 | 一种确定焊接位置的方法、装置及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1055214A (ja) * | 1996-08-09 | 1998-02-24 | Daihen Corp | 産業用ロボットの制御方法 |
EP2789430A1 (en) * | 2013-04-12 | 2014-10-15 | Sabanci University | A series elastic holonomic mobile platform for upper extremity rehabilitation |
CN104932506A (zh) * | 2015-06-09 | 2015-09-23 | 东南大学 | 基于快速终端滑模的轮式移动机器人轨迹跟踪方法 |
CN105904458A (zh) * | 2016-05-16 | 2016-08-31 | 西北工业大学 | 一种基于复杂操作任务的非完整遥操作约束控制方法 |
CN106707749A (zh) * | 2016-12-14 | 2017-05-24 | 北京科技大学 | 一种针对仿生扑翼飞行机器人的控制方法 |
-
2019
- 2019-03-11 CN CN201910179184.5A patent/CN109746922A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1055214A (ja) * | 1996-08-09 | 1998-02-24 | Daihen Corp | 産業用ロボットの制御方法 |
EP2789430A1 (en) * | 2013-04-12 | 2014-10-15 | Sabanci University | A series elastic holonomic mobile platform for upper extremity rehabilitation |
CN104932506A (zh) * | 2015-06-09 | 2015-09-23 | 东南大学 | 基于快速终端滑模的轮式移动机器人轨迹跟踪方法 |
CN105904458A (zh) * | 2016-05-16 | 2016-08-31 | 西北工业大学 | 一种基于复杂操作任务的非完整遥操作约束控制方法 |
CN106707749A (zh) * | 2016-12-14 | 2017-05-24 | 北京科技大学 | 一种针对仿生扑翼飞行机器人的控制方法 |
Non-Patent Citations (1)
Title |
---|
HUA CHEN 等: "Finite-Time Switching Control of Nonholonomic Mobile Robots for Moving Target Tracking Based on Polar Coordinates", 《COMPLEXITY》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111477003A (zh) * | 2020-04-13 | 2020-07-31 | 联陆智能交通科技(上海)有限公司 | 获取与弱势交通者相撞时间的计算方法和系统及介质 |
CN112907625A (zh) * | 2021-02-05 | 2021-06-04 | 齐鲁工业大学 | 应用于四足仿生机器人的目标跟随方法及系统 |
CN114211173A (zh) * | 2022-01-27 | 2022-03-22 | 上海电气集团股份有限公司 | 一种确定焊接位置的方法、装置及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109746922A (zh) | 一种基于有限时间切换控制的非完整机器人控制方法 | |
CN106094835B (zh) | 前轮驱动车式移动机器人的动态编队控制方法 | |
EP3633480B1 (en) | Point stabilization control method and device for mobile robot | |
CN104570938A (zh) | 一种插装生产中的双臂机器人系统及其智能控制方法 | |
CN109839934A (zh) | 基于rise技术的无人水面艇预设性能跟踪控制方法 | |
CN108614563A (zh) | 一种通过定位导航实现移动机器人目标跟随的方法 | |
CN103568012B (zh) | 一种弧焊机器人双平面摆弧轨迹的规划方法 | |
CN105929849B (zh) | 一种基于点镇定的轮式移动机器人目标跟踪控制方法 | |
CN106371442B (zh) | 一种基于张量积模型变换的移动机器人控制方法 | |
CN112256001B (zh) | 一种视角约束下的移动机器人视觉伺服控制方法 | |
CN108614560A (zh) | 一种移动机器人视觉伺服保性能跟踪控制方法 | |
CN104236456A (zh) | 一种基于两自由度3d视觉传感器的机器人手眼标定方法 | |
CN104298244A (zh) | 一种工业机器人三维实时高精度定位装置及方法 | |
Wang et al. | Research on logistics autonomous mobile robot system | |
CN113721639B (zh) | 一种用于小型水下机器人入坞的路径规划方法及控制方法 | |
CN113325852B (zh) | 基于领导跟随者方式的多智能体行进中编队变换的控制方法 | |
CN112650217B (zh) | 一种基于评估函数的机器人轨迹跟踪策略动态优化方法 | |
CN101700596B (zh) | 移动焊接机器人焊前自寻迹的方法 | |
CN111947647A (zh) | 一种视觉与激光雷达融合的机器人精准定位方法 | |
Srivastava et al. | Range estimation and visual servoing of a dynamic target using a monocular camera | |
CN111251303A (zh) | 一种周期性姿态调整的机器人运动控制方法 | |
CN109946970A (zh) | 一种基于观测器的非完整机器人速度信息的获取方法 | |
CN111830832B (zh) | 仿生滑翔机器海豚平面路径跟踪方法及系统 | |
CN112684793B (zh) | 一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法 | |
CN115061142A (zh) | 一种基于激光雷达的agv定位方法及系统 |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190514 |
|
RJ01 | Rejection of invention patent application after publication |