CN108614560B - 一种移动机器人视觉伺服保性能跟踪控制方法 - Google Patents
一种移动机器人视觉伺服保性能跟踪控制方法 Download PDFInfo
- Publication number
- CN108614560B CN108614560B CN201810548969.0A CN201810548969A CN108614560B CN 108614560 B CN108614560 B CN 108614560B CN 201810548969 A CN201810548969 A CN 201810548969A CN 108614560 B CN108614560 B CN 108614560B
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- performance
- defining
- camera
- tracking
- 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
- 238000000034 method Methods 0.000 title claims abstract description 33
- 230000000007 visual effect Effects 0.000 title claims abstract description 16
- 239000011159 matrix material Substances 0.000 claims description 17
- 238000005070 sampling Methods 0.000 claims description 6
- 238000013461 design Methods 0.000 claims description 5
- 239000000126 substance Substances 0.000 claims description 4
- 238000005457 optimization Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 230000003044 adaptive effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012545 processing Methods 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Feedback Control In General (AREA)
Abstract
一种移动机器人视觉伺服保性能跟踪控制方法,包括以下步骤:1)考虑输入约束,将移动机器人视觉伺服跟踪控制问题建模成一类具有参数不确定的跟踪误差状态空间模型;2)设计保性能指标函数;3)基于保性能控制算法设计路径跟踪控制器;4)定义输入约束;5)设计保性能跟踪控制器。本发明提供了一种可以有效解决具有输入约束的移动机器人视觉伺服保性能路径跟踪控制方法。
Description
技术领域
本发明涉及基于视觉的移动机器人路径跟踪控制系统,尤其涉及的是存在输入限制移动机器人视觉伺服保性能控制方法。
背景技术
随着科学技术和控制技术的发展,计算机视觉在各个领域已有广泛的运用,视觉数据信息量丰富,处理手段丰富等特点使得基于视觉的移动机器人控制被广泛应用于科研、军事、工业以及物流等领域。路径跟踪作为移动机器人运动控制中的基本问题之一,一直备受广泛关注。因此,针对基于视觉的移动机器人路径跟踪控制技术的研究,不仅可以丰富移动机器人运动控制的理论成果,还可以满足多领域对运动控制技术越来越高的要求,具有重大的理论和工程意义。此外,通过引入视觉信息,延展了移动机器人的能力范围,可以有效满足人机交互的需求。
然而在实际环境中,特别是非固定场景,不可避免地存在光线因素以及各种干扰问题,给基于视觉的移动机器人路径跟踪控制带来了新的挑战。
保性能控制方法是一种将系统分为名义系统和参数不确定系统两个部分并且设计控制器使得整个系统李雅普诺夫渐近稳定的控制策略。相较于其他控制方法,保性能控制可以处理输入约束以及参数不确定问题,近年来在移动机器人路径跟踪控制领域受到了普遍的关注。郭一军等在论文(具有控制输入约束的轮式移动机器人轨迹跟踪最优保性能控制)中利用保性能控制算法设计了无视觉的移动机器人轨迹跟踪控制器,Wang等在论文(Adaptive Optimal Kinematic Tracking Control of Nonholonomic Mobile Robot)中,针对基于视觉的移动机器人路径跟踪问题,提出了一种自适应最优运动学控制方法。Lang等在论文(Visual Servoing with LQR Control for Mobile Robots)中,利用线性最优控制方法,求得控制器参数和性能指标,实现基于视觉的移动机器人的跟踪。然而,这些结果都没有将基于视觉的移动机器人系统分为名义系统和参数不确定系统两个部分并且设计保性能控制器。并且在实际应用中,移动机器人的线速度与角速度有一定的限制,因此,针对具有输入约束的移动机器人视觉伺服保性能跟踪控制方法的研究很有必要。
发明内容
为了克服现有技术无法解决移动机器人视觉伺服保性能跟踪控制问题的不足,本发明提供一种移动机器人视觉伺服保性能跟踪控制方法,通过将该问题建模为一类具有参数不确定的跟踪误差模型,基于该模型给出了保性能指标,同时提供了保性能反馈控制器求解方法。
本发明解决其技术问题所采用的技术方案是:
一种移动机器人视觉伺服保性能跟踪控制方法,包括以下步骤:
1)建立基于视觉的移动机器人模型,定义x和y为归一化后的相机横纵坐标,zc为相机的z轴坐标,相机在相机坐标系下的速度矢量为vc和ωc分别为移动机器人的在z轴线速度和x-z平面角速度,机器人在自身坐标系下的速度矢量为vr和ωr分别为移动机器人的参考在z轴线速度和x-z平面角速度,则基于视觉的移动机器人运动学模型为:
2)建立基于视觉的移动机器人跟踪误差模型,定义ρ1和ρ2代表特征点在像素坐标系下的实时位置
定义yc是摄像机的原点到特征点的高度,对(2)式进行求导得
eθ=θ-θ* (4)
把式(3)代入(5)中得
将式(6)进行利用采样周期T的一阶泰勒级数展开法离散化,得到模型:
e(k+1)=A(ω(k))e(k)+Bu(k) (7)
定义角速度更新规则为
ωc(k+1)=0.6ωc(k)+0.2e-0.01kT (8)
由于ωc(k)是有界时变参数,将系统转化为参数不确定模型处理有界时变参数:
ΔA=DF(t)E
3)定义保性能指标函数
其中,Q和R表示权重矩阵;
定义李雅普诺夫函数V(e(k))=eT(k)Pe(k),则
ΔV(k)=eT(k+1)Pe(k+1)-eT(k)Pe(k)≤-[eT(k)Qe(k)+uT(k)Ru(k)] (11)
其中P是2维对称正定矩阵,即:
eT(k)Qe(k)+uT(k)Ru(k)≤-ΔV(k) (12)
对(12)两边求和,并利用闭环系统的渐近稳定性,得
即:
根据李雅普诺夫渐近稳定性理论可知,最小化V(e(k))等价于
s.t.J≤eT(0)Pe(0)≤γ
4)定义输入约束
||u(k)||2≤umax (13)
其中umax表示输入的最大值,利用线性矩阵不等式方法得式(13)等价于
5)设计保性能跟踪控制器
利用李雅普诺夫稳定性理论及线性矩阵不等式方法得到保证移动机器人移动到期望位置的充分条件:
通过Matlab中的LMI工具箱求解得W,X,进一步得移动机器人跟踪问题反馈控制器的解为u(k)=K(k)e(k),其中,K=WX-1。
本发明的技术构思为:首先,考虑输入限制的影响,将移动机器人跟踪控制问题建模为一类具有参数不确定的跟踪误差状态空间模型。然后,基于该模型给出保性能指标并将其转化为一个最优化问题。最后,采用保性能控制方法求解优化问题,给出了通过LMI求解控制器参数的方法。
本发明的有益效果主要表现在:通过将输入限制和参数不确定系统转化为线性矩阵不等式,易于求解最优化问题;结合保性能方法求解反馈控制器参数,能够离线计算控制器参数;给出了反馈控制器的具体参数,有效解决了具有输入约束影响下移动机器人视觉伺服保性能跟踪控制问题。
附图说明
图1是移动机器人坐标建立示意图。
具体实施方式
下面结合附图对本发明作进一步描述。
参照图1,一种移动机器人视觉伺服保性能跟踪控制方法,包括以下步骤:
1)建立基于视觉的移动机器人模型,定义x和y为归一化后的相机横纵坐标,zc为相机在z轴的坐标,相机在相机坐标系下的速度矢量为vc和ωc分别为移动机器人的在z轴线速度和x-z平面角速度,机器人在自身坐标系下的速度矢量为vr和ωr分别为移动机器人的参考在z轴线速度和x-z平面角速度,则基于视觉的移动机器人运动学模型为:
2)建立跟踪误差模型,定义ρ1和ρ2代表特征点在像素坐标系下的实时位置
定义yc是摄像机原点到特征点的高度,对式(2)求导得
eθ=θ-θ* (4)
把式(3)代入(5)中得
将式(6)进行利用采样周期T的一阶泰勒级数展开法离散化得:
e(k+1)=A(ω(k))e(k)+Bu(k) (7)
定义角速度更新规则为
ωc(k+1)=0.6ωc(k)+0.2e-0.01kT (8)
由于ωc(k)是有界时变参数,可以将系统转化为参数不确定模型处理有界时变参数:
ΔA=DF(t)E
3)定义保性能指标函数
其中,Q和R表示权重矩阵;
定义李雅普诺夫函数V(e(k))=eT(k)Pe(k),则
ΔV(k)=eT(k+1)Pe(k+1)-eT(k)Pe(k)≤-[eT(k)Qe(k)+uT(k)Ru(k)] (11)
其中P是2维对称正定矩阵,即:
eT(k)Qe(k)+uT(k)Ru(k)≤-ΔV(k) (12)
对(12)两边求和,并利用闭环系统的渐近稳定性,得
即:
根据李雅普诺夫渐近稳定性理论可知,最小化V(e(k))等价于
s.t.J≤eT(0)Pe(0)≤γ
4)定义输入约束
||u(k)||2≤umax (13)
其中,umax表示输入的最大值,利用线性矩阵不等式方法可将式(13)转化为以下不等式
5)设计保性能跟踪控制器
利用李雅普诺夫稳定性理论及线性矩阵不等式方法得到保证移动机器人移动到期望位置的充分条件:
通过Matlab中的LMI工具箱求解得W,X,进一步得移动机器人跟踪问题反馈控制器的解为u(k)=K(k)e(k),其中,K=WX-1。
Claims (1)
1.一种移动机器人视觉伺服保性能控制方法,其特征在于,所述方法包括以下步骤:
1)建立基于视觉的移动机器人模型,定义x和y为归一化后的相机横纵坐标,zc为相机在z轴的坐标,相机在相机坐标系下的速度矢量为vc和ωc分别为移动机器人的在z轴线速度和x-z平面角速度,机器人在自身坐标系下的速度矢量为vr和ωr分别为移动机器人的参考在z轴线速度和x-z平面角速度,则基于视觉的移动机器人运动学模型为:
2)建立跟踪误差模型,定义ρ1和ρ2代表特征点在像素坐标系下的实时位置
定义yc是摄像机原点与特征点的高度差,对式(2)求导得
eθ=θ-θ* (4)
把式(3)代入(5)中得
将式(6)进行利用采样周期T的一阶泰勒级数展开法离散化得:
e(k+1)=A(ω(k))e(k)+Bu(k) (7)
定义角速度更新规则为
ωc(k+1)=0.6ωc(k)+0.2e-0.01kT (8)
由于ωc(k)是有界时变参数,将系统转化为参数不确定模型处理有界时变参数:
ΔA=DF(t)E
3)定义保性能指标函数
其中,Q和R表示权重矩阵;
定义李雅普诺夫函数V(e(k))=eT(k)Pe(k),则
ΔV(k)=eT(k+1)Pe(k+1)-eT(k)Pe(k)≤-[eT(k)Qe(k)+uT(k)Ru(k)] (11)
其中P是2维对称正定矩阵,即:
eT(k)Qe(k)+uT(k)Ru(k)≤-ΔV(k) (12)
对(12)两边求和,并利用闭环系统的渐近稳定性,得
即:
根据李雅普诺夫渐近稳定性理论可知,最小化V(e(k))等价于
s.t.J≤eT(0)Pe(0)≤γ
4)定义输入约束
||u(k)||2≤umax (13)
其中,umax表示输入的最大值,利用线性矩阵不等式方法将式(13)转化为以下不等式
5)设计保性能跟踪控制器
利用李雅普诺夫稳定性理论及线性矩阵不等式方法得到保证移动机器人移动到期望位置的充分条件:
通过Matlab中的LMI工具箱求解得W,X,进一步得移动机器人跟踪问题反馈控制器的解为u(k)=K(k)e(k),其中,K=WX-1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810548969.0A CN108614560B (zh) | 2018-05-31 | 2018-05-31 | 一种移动机器人视觉伺服保性能跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810548969.0A CN108614560B (zh) | 2018-05-31 | 2018-05-31 | 一种移动机器人视觉伺服保性能跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108614560A CN108614560A (zh) | 2018-10-02 |
CN108614560B true CN108614560B (zh) | 2021-04-06 |
Family
ID=63664481
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810548969.0A Active CN108614560B (zh) | 2018-05-31 | 2018-05-31 | 一种移动机器人视觉伺服保性能跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108614560B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109358507B (zh) * | 2018-10-29 | 2020-08-28 | 东北大学 | 一种时变性能边界约束的视觉伺服自适应跟踪控制方法 |
CN109949375B (zh) * | 2019-02-02 | 2021-05-14 | 浙江工业大学 | 一种基于深度图感兴趣区域的移动机器人目标跟踪方法 |
CN110244703B (zh) * | 2019-03-28 | 2022-05-03 | 浙江工业大学 | 一种具有外部干扰和数据异常的移动机器人预测控制方法 |
CN110209057A (zh) * | 2019-06-26 | 2019-09-06 | 哈尔滨工业大学(深圳) | 一种最优状态反馈保性能的amd控制器的设计方法 |
CN111931387B (zh) * | 2020-09-23 | 2020-12-22 | 湖南师范大学 | 一种面向移动柱状组合体的视觉伺服趋近方法 |
CN112859853B (zh) * | 2021-01-08 | 2022-07-12 | 东南大学 | 考虑时延和环境约束的智能收获机器人路径控制方法 |
CN113031590B (zh) * | 2021-02-06 | 2022-09-23 | 浙江同筑科技有限公司 | 一种基于李雅普诺夫函数的移动机器人视觉伺服控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102608997A (zh) * | 2011-01-25 | 2012-07-25 | 同济大学 | 一种基于人工场的轨迹跟踪控制方法 |
KR20140086246A (ko) * | 2012-12-28 | 2014-07-08 | 레드원테크놀러지 주식회사 | 다중 이동 로봇의 대형 제어 방법 및 시스템 |
CN104881044A (zh) * | 2015-06-11 | 2015-09-02 | 北京理工大学 | 一种姿态未知的多移动机器人系统的自适应跟踪控制方法 |
CN105549598A (zh) * | 2016-02-16 | 2016-05-04 | 江南大学 | 一种二维运动移动机器人的迭代学习轨迹跟踪控制及其鲁棒优化方法 |
JP2017045250A (ja) * | 2015-08-26 | 2017-03-02 | トヨタ自動車株式会社 | 全方位移動体、その制御方法及びプログラム |
CN106774309A (zh) * | 2016-12-01 | 2017-05-31 | 天津工业大学 | 一种移动机器人同时视觉伺服与自适应深度辨识方法 |
CN107015562A (zh) * | 2017-04-26 | 2017-08-04 | 华南理工大学 | 一种满足预设跟踪性能的欠驱动水面船舶控制方法 |
CN207182101U (zh) * | 2017-07-25 | 2018-04-03 | 成都纵横科宇自动化技术有限公司 | 一种随动模拟跟随控制系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9717387B1 (en) * | 2015-02-26 | 2017-08-01 | Brain Corporation | Apparatus and methods for programming and training of robotic household appliances |
-
2018
- 2018-05-31 CN CN201810548969.0A patent/CN108614560B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102608997A (zh) * | 2011-01-25 | 2012-07-25 | 同济大学 | 一种基于人工场的轨迹跟踪控制方法 |
KR20140086246A (ko) * | 2012-12-28 | 2014-07-08 | 레드원테크놀러지 주식회사 | 다중 이동 로봇의 대형 제어 방법 및 시스템 |
CN104881044A (zh) * | 2015-06-11 | 2015-09-02 | 北京理工大学 | 一种姿态未知的多移动机器人系统的自适应跟踪控制方法 |
JP2017045250A (ja) * | 2015-08-26 | 2017-03-02 | トヨタ自動車株式会社 | 全方位移動体、その制御方法及びプログラム |
CN105549598A (zh) * | 2016-02-16 | 2016-05-04 | 江南大学 | 一种二维运动移动机器人的迭代学习轨迹跟踪控制及其鲁棒优化方法 |
CN106774309A (zh) * | 2016-12-01 | 2017-05-31 | 天津工业大学 | 一种移动机器人同时视觉伺服与自适应深度辨识方法 |
CN107015562A (zh) * | 2017-04-26 | 2017-08-04 | 华南理工大学 | 一种满足预设跟踪性能的欠驱动水面船舶控制方法 |
CN207182101U (zh) * | 2017-07-25 | 2018-04-03 | 成都纵横科宇自动化技术有限公司 | 一种随动模拟跟随控制系统 |
Non-Patent Citations (4)
Title |
---|
An improved approach to reliable H∞ guaranteed cost control for discrete time LPV systems with control input constraints;Yangyang Zhao;《Journal of the Franklin Institute》;20121231;366-382 * |
Trajectory Tracking Control of an Excavator Arm Using Guaranteed Cost Control;Alexander Gurko;《Informatics in Control, Automation and Robotics 12th International Conference》;20150723;177-196 * |
具有控制输入约束的轮式移动机器人轨迹跟踪最优保性能控制;郭一军;《系统科学与数学》;20170831;第37卷(第8期);1757-1769 * |
基于T-S模型的欠驱动机器人非脆弱保性能H∞控制;吴忠强;《中国机械工程》;20101130(第11期);1319-1324 * |
Also Published As
Publication number | Publication date |
---|---|
CN108614560A (zh) | 2018-10-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108614560B (zh) | 一种移动机器人视觉伺服保性能跟踪控制方法 | |
CN108839026B (zh) | 一种移动机器人视觉伺服跟踪预测控制方法 | |
CN109828600B (zh) | 时间最优快速三维避障路径规划方法 | |
Qiu et al. | Visual servo tracking of wheeled mobile robots with unknown extrinsic parameters | |
Koubaa et al. | Adaptive sliding-mode dynamic control for path tracking of nonholonomic wheeled mobile robot | |
Yu et al. | Stable neural PID anti-swing control for an overhead crane | |
CN109760047B (zh) | 一种基于视觉传感器的舞台机器人预测控制方法 | |
Khalaji et al. | Lyapunov-based formation control of underwater robots | |
Shi et al. | Adaptive image-based visual servoing for hovering control of quad-rotor | |
CN110095983A (zh) | 一种基于路径参数化的移动机器人预测跟踪控制方法 | |
Sun et al. | Research on the trajectory tracking control of a 6-dof manipulator based on fully-actuated system models | |
CN110977982A (zh) | 基于深度视觉的双机械臂控制方法 | |
Liu et al. | Finite-time attitude control: a finite-time passivity approach | |
Pérez-Alcocer et al. | A novel Lyapunov-based trajectory tracking controller for a quadrotor: Experimental analysis by using two motion tasks | |
Qu et al. | Dynamic visual tracking for robot manipulator using adaptive fading Kalman filter | |
Mechali et al. | Finite-time attitude control of uncertain quadrotor aircraft via continuous terminal sliding-mode-based active anti-disturbance approach | |
Qi et al. | Three-dimensional formation control based on filter backstepping method for multiple underactuated underwater vehicles | |
Filaretov et al. | Synthesis of system for automatic formation of multilink manipulator velocity | |
CN112643673A (zh) | 基于非线干扰观测器的移动机械臂鲁棒控制方法及系统 | |
CN110647161B (zh) | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 | |
CN115202206A (zh) | 一种集群飞行器系统的控制器自动设计方法 | |
Kanjanawanishkul | Coordinated path following for mobile robots using a virtual structure strategy with model predictive control | |
Timchenko et al. | Robust-optimal control system of quadrocopter for maritime traffic's monitoring | |
Song et al. | Enhanced fireworks algorithm-auto disturbance rejection control algorithm for robot fish path tracking | |
Zhang et al. | Remote tracking of nonholonomic mobile robots via networked predictive control |
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 |