CN104317299B - 一种基于轮式移动机器人轨迹跟踪的混合控制方法 - Google Patents
一种基于轮式移动机器人轨迹跟踪的混合控制方法 Download PDFInfo
- Publication number
- CN104317299B CN104317299B CN201410631147.0A CN201410631147A CN104317299B CN 104317299 B CN104317299 B CN 104317299B CN 201410631147 A CN201410631147 A CN 201410631147A CN 104317299 B CN104317299 B CN 104317299B
- Authority
- CN
- China
- Prior art keywords
- robot
- control method
- sliding
- overbar
- mobile 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
Landscapes
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开一种基于轮式移动机器人轨迹跟踪的混合控制方法,由运动学的虚拟速度控制器,基于动力学的滑模力矩控制器和扰动观测器三个部分。虚拟速度控制器包括机器人线速度和角速度的设计;滑模控制器包括滑模面的设计和滑模控制律的设计;扰动观测器用来观测系统的外部扰动,来降低滑模控制器的控制量,作为前馈项引入。本发明所涉及的混合控制方法能够使得系统在参数有界变化和外界扰动的情况下实现对机器人轨迹跟踪控制。仿真实验表明该发明的混合控制方法能有效地减小滑模控制输出的抖振,有效降低控制量的输出,并且具有良好的鲁棒性。
Description
技术领域
本发明属于移动机器人的轨迹跟踪控制领域,尤其涉及到一种基于轮式移动机器人轨迹跟踪的混合控制方法。
背景技术
轮式移动机器人是一种将环境感知、动态决策与规划、行为控制与执行等多种功能综合于一体的移动平台,具备高度自规划、自组织和自适应能力,可在无人干预和复杂环境下有目的地自主运动,并完成特定的作业功能。由于轮式移动机器人在物料自动搬运、特殊人群服务、抢险救灾、未知和危险地域探索等方面应用具有不可比拟的优势,已广泛地应用于工农业、服务业、国防、宇宙探索等领域,对人类社会的生产和生活产生了积极而深远的影响。
非完整轮式移动机器人(wheeled mobile robot,WMR)是一种典型的多输入多输出耦合欠驱动非线性系统,其运动控制问题极具挑战性。一方面,应当考虑实际系统一些被忽略的固有非线性特性,如摩擦、间隙、执行器饱和等;另一方面,系统还会受到外界扰动以及参数不确定性的影响,这些因素造成实际系统与理想数学模型出现较大的偏差。基于理想数学模型所设计的控制律往往难以达到所需的控制指标,甚至会引起系统不稳定。需设法来消除系统不确定性的不利影响,这给运动控制带来了更大的挑战。因此,解决复杂情况下非完整轮式移动机器人的运动控制问题具有重要的理论意义和实际应用价值。
滑模控制作为一种变结构控制方法,当系统运动状态到达滑模面上时,对系统参数的不确定性以及外界干扰有着很强的鲁棒性。(张鑫,刘凤娟,闫茂德.基于动力学模型的轮式移动机器人自适应滑模轨迹跟踪控制[J].机械科学与技术.2012(01))采用自适应滑模控制算法,实现机器人轨迹跟踪。但对于较大扰动滑模控制会引起系统的抖振,本发明结合扰动观测器,以降低外部扰动带来的抖振问题。
发明内容
发明目的:本发明所要解决的技术问题是给出一种能够在轮式移动机器人控制系统存在参数扰动和外界干扰的情况下进行轨迹跟踪控制。
技术方案:本发明采用如下技术方案解决上述技术问题:设计了一种基于轮式移动机器人轨迹跟踪的混合控制方法,包括如下具体步骤:
步骤(1):对轨迹模型和机器人执行机构进行分析,建立具有非完整性约束的移动机器人运动学模型和动力学模型;
步骤(2):利用单目摄像头获取轨迹,结合步骤(1)所推导的运动学模型,确定机器人要实现轨迹跟踪虚拟线速度和角速度控制器vc,wc;
步骤(3):利用光电编码器获取机器人两轮的角速度根据转换公式计算实际的机器人线速度和角速度v,w;计算步骤(2)中获得的虚拟速度和角速度与实际速度和角速度的偏差
步骤(4):根据步骤(3)中的选择合适的滑模面S;
步骤(5):根据步骤(4)中的滑模面S确定移动机器人左右轮驱动电机的力矩控制量(τ1,τ2)T;
步骤(6):根据步骤(5)的(τ1,τ2)T和当前的机器人实际速度v,w设计干扰观测器并进行相应的前馈补偿,减小系统抖振。
作为本发明的第一个改进,步骤(4)中所选择的滑膜面为:
式中,S1,S2为滑模面,c1,c2>0为滑模系数,t定义为实际变量。
根据上述的滑模面,步骤(5)中所选择的左右轮的力矩控制量为:
其中,τ1,τ2为左右轮的控制力矩;m是机器人质量,I机器人转动惯量,k3,k4是可设定的增益量,sgn(Si)是关于滑模面Si的符号函数,分别是左右轮的外加扰动的观测器估计值。
本发明的第二个改进,由于外界扰动很难确定上界,当扰动量很大时滑模控制容易带来抖振,因而结合干扰观测器来解决外部扰动的影响,以减小系统的抖振,且易于实际工程的实现。步骤(6)中所选择的针对通用模型的干扰观测器为:
其中,外加扰动源满足 其中E是一个频率矩阵是扰动频率;p(α)是需要设计的非线性函数,是非线性干扰观测器的增益。通过调节l可以决定观测器的收敛速度。
有益效果:本发明由运动学的虚拟速度控制器,基于动力学的滑模力矩控制器和扰动观测器三个部分。虚拟速度控制器包括机器人线速度和角速度的设计,目的是保证机器人的运动轨迹能跟踪期望的轨迹;滑模控制器包括滑模面的设计和滑模控制律的设计,目的是保证力矩控制器能够提供与虚拟速度同样大小和方向的实际速度,从而保证闭环系统的稳定性。扰动观测器用来观测系统的外部扰动,来降低滑模控制器的控制量,作为前馈项引入。本发明所涉及的混合控制方法能够使得系统在参数有界变化和外界扰动的情况下实现对机器人轨迹跟踪控制。仿真实验表明该发明的混合控制方法能有效地减小滑模控制输出的抖振,有效降低控制量的输出,并且具有良好的鲁棒性。
附图说明
图1是本发明中两轮驱动移动机器人模型示意图;
图2是本发明中轮式移动机器人控制的原理简图;
图3是本发明中轮式移动机器人控制的原理实现框图;
图4是本发明在没有干扰观测器(DOB)的情况下的左轮力矩控制量;
图5是本发明在有干扰观测器(DOB)的情况下的左轮力矩控制量;
图6是本发明在没有干扰观测器(DOB)的情况下的右轮力矩控制量;
图7是本发明在有干扰观测器(DOB)的情况下的右轮力矩控制量;
图8是本发明中干扰观测器(DOB)对外界扰动的观测;
图9是本发明中轮式移动机器人跟踪圆轨迹的轨迹曲线图;
图10是本发明中轮式移动机器人跟踪圆轨迹时的误差曲线图;
图11是本发明中轮式移动机器人跟踪直线轨迹的轨迹曲线图;
图12是本发明中轮式移动机器人跟踪直线轨迹时的误差曲线图。
具体实施方式
下面结合附图对本发明作进一步说明:
如图1-图12所示,本发明设计了一种基于轮式移动机器人轨迹跟踪的混合控制方法,包括如下具体步骤:
步骤(1):对轨迹模型和机器人执行机构进行分析,建立具有非完整性约束的移动机器人运动学模型和动力学模型;
步骤(2):利用单目摄像头获取轨迹,结合步骤(1)所推导的运动学模型,确定机器人要实现轨迹跟踪虚拟线速度和角速度控制器vc,wc;
步骤(3):利用光电编码器获取机器人两轮的角速度根据
转换公式计算实际的机器人线速度和角速度v,w;计算步骤(2)中获得的虚拟速度和角速度与实际速度和角速度的偏差
步骤(4):根据步骤(3)中的选择合适的滑模面S;
步骤(5):根据步骤(4)中的滑模面S确定移动机器人左右轮驱动电机的力矩控制量(τ1,τ2)T;
步骤(6):根据步骤(5)的(τ1,τ2)T和当前的机器人实际速度v,w设计干扰观测器并进行相应的前馈补偿,减小系统抖振。
作为本发明的第一个改进,步骤(4)中所选择的滑膜面为:
式中,S1,S2为滑模面,c1,c2>0为滑模系数,t定义为实际变量。
根据上述的滑模面,步骤(5)中所选择的左右轮的力矩控制量为:
其中,τ1,τ2为左右轮的控制力矩。m是机器人质量,I机器人转动惯量,k3,k4是可设定的增益量,sgn(Si)是关于滑模面Si的符号函数,分别是左右轮的外加扰动的观测器估计值。
本发明的第二个改进,由于外界扰动很难确定上界,当扰动量很大时滑模控制容易带来抖振,因而结合干扰观测器来解决外部扰动的影响,以减小系统的抖振,且易于实际工程的实现。步骤(6)中所选择的针对通用模型的干扰观测器为:
其中,外加扰动源满足 其中E是一个频率矩阵是扰动频率。p(α)是需要设计的非线性函数,是非线性干扰观测器的增益。通过调节l可以决定观测器的收敛速度。
在具体实例中,我们设计的运动学虚拟线速度和角速度控制器,滑模力矩控制器和干扰观测器的步骤如下:
步骤1:建立轮式移动机器人的运动学模型:
约束条件是:其中q=[x,y,θ]T是系统的状态,即移动机器人位姿,(x,y)为质心在世界坐标系中的坐标(单位:m),θ为机器人姿态角(单位:rad),v,w分别是机器人的线速度和角速度。期望轨迹模型 (xr,yr,θr)是期望轨迹状态,(vr,wr)是期望线速度和角速度。针对期望轨迹和运动学模型建立误差模型
步骤2:设计虚拟速度控制器使得误差最终趋于零:
其中,k1,k2是正数。取李雅普诺夫方程:
将虚拟速度控制器代入可得
步骤3:根据执行机构以及周边的环境建立动力学模型:
对上式进行一定的变换,得
其中,
步骤4:针对线速度和角速度的误差设计滑模面
步骤5:设计左、右轮的力矩控制器来控制机器人的速度
其中,τ1,τ2分别是左右轮的驱动力矩。
令 和 将其视为内部的扰动,利用滑模来处理。取李雅普诺夫方程如下:
求导可得:
只要满足 就有
s2采用上述同样的方法也可以得到相应的稳定性结果。
步骤6:针对通用模型的干扰观测器为:
其中,外加扰动源满足 E是一个频率矩阵是扰动频率。是非线性干扰观测器的增益;p(α)是需要设计的非线性函数,使得观测器以一定的速度收敛。
对于干扰误差的证明如下:
只要能满足[E-lg2H]的所有特征值均具有负实部,该观测器就可以收敛。
在本例中要针对线速度和角速度模型分别设计观测器。线速度模型与通用模型对应参数是 角速度模型与通用模型对应的参数是
综合以上稳定性的分析,本发明所设计的混合控制算法可以使得整个闭环系统是稳定的,跟踪效果好,具有较强的鲁棒性。
Claims (4)
1.一种基于轮式移动机器人轨迹跟踪的混合控制方法,其特征在于,包括如下步骤:
步骤(1):对轨迹模型和机器人执行机构进行分析,建立具有非完整性约束的移动机器人运动学模型和动力学模型;
步骤(2):利用单目摄像头获取轨迹,结合步骤(1)所推导的运动学模型,确定机器人要实现轨迹跟踪虚拟线速度和角速度控制器vc,wc;
步骤(3):利用光电编码器获取机器人两轮的角速度根据转换公式计算实际的机器人线速度和角速度v,w;计算步骤(2)中获得的虚拟速度和角速度与实际速度和角速度的偏差
步骤(4):根据步骤(3)中的选择合适的滑模面S;
步骤(5):根据步骤(4)中的滑模面S确定移动机器人左右轮驱动电机的力矩控制量(τ1,τ2)T;所述步骤(5)中所选择τ1,τ2为:
其中τ1,τ2为左右轮的控制力矩,用来驱动左右轮产生相应的速度;m是机器人质量,I机器人转动惯量,k3,k4是可设定的增益,sgn(Si)是关于滑模面Si的符号函数;分别是左右轮的外加扰动的观测器估计值;
步骤(6):根据步骤(5)的(τ1,τ2)T和当前的机器人实际速度v,w设计干扰观测器并进行相应的前馈补偿,从而减小系统抖振。
2.根据权利要求1所述的基于轮式移动机器人轨迹跟踪的混合控制方法,其特征在于,所述步骤(3)中所选择的vc,wc为:
其中vr,wr分别为期望线速度和角速度,xe,ye,θe为机器人的实际位姿与期望轨迹的位姿偏差,k1,k2是正常数。
3.根据权利要求1所述的基于轮式移动机器人轨迹跟踪的混合控制方法,其特征在于,所述步骤(4)中所选择的滑模面为:
式中,S1,S2为滑模面,c1,c2>0为滑模系数,t定义为实际变量。
4.根据权利要求1所述的基于轮式移动机器人轨迹跟踪的混合控制方法,其特征在于,所述步骤(6)中所选择的针对通用模型的干扰观测器为:
其中,外加扰动源满足其中E是一个频率矩阵 是扰动频率;p(α)是需要设计的非线性函数,是非线性干扰观测器的增益;通过调节l可以决定观测器的收敛速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410631147.0A CN104317299B (zh) | 2014-11-11 | 2014-11-11 | 一种基于轮式移动机器人轨迹跟踪的混合控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410631147.0A CN104317299B (zh) | 2014-11-11 | 2014-11-11 | 一种基于轮式移动机器人轨迹跟踪的混合控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104317299A CN104317299A (zh) | 2015-01-28 |
CN104317299B true CN104317299B (zh) | 2017-01-25 |
Family
ID=52372541
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410631147.0A Active CN104317299B (zh) | 2014-11-11 | 2014-11-11 | 一种基于轮式移动机器人轨迹跟踪的混合控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104317299B (zh) |
Families Citing this family (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105589460B (zh) * | 2015-05-19 | 2019-07-12 | 中国人民解放军国防科学技术大学 | 一种控制运动车体的方法及装置 |
CN104932506B (zh) * | 2015-06-09 | 2017-09-19 | 东南大学 | 基于快速终端滑模的轮式移动机器人轨迹跟踪方法 |
CN105137968A (zh) * | 2015-07-20 | 2015-12-09 | 柳州一健科技有限公司 | 一种基于扰动观测的农用车自动转向控制方法 |
CN107368081B (zh) * | 2015-08-17 | 2019-07-30 | 杭州电子科技大学 | 一种两轮自平衡机器人自适应滑模变结构控制系统 |
CN105466428B (zh) * | 2015-11-27 | 2019-09-20 | 北京航空航天大学 | 一种基于机器人位置和速度信息的姿态角观测方法 |
CN105629729A (zh) * | 2016-01-04 | 2016-06-01 | 浙江工业大学 | 一种基于线性自抗扰的网络化移动机器人轨迹跟踪控制方法 |
CN105929849B (zh) * | 2016-04-28 | 2018-10-23 | 东南大学 | 一种基于点镇定的轮式移动机器人目标跟踪控制方法 |
CN106137400B (zh) * | 2016-05-31 | 2019-06-18 | 微创(上海)医疗机器人有限公司 | 用于机械臂的控制系统、控制方法及一种手术机器人 |
CN106125728B (zh) * | 2016-07-05 | 2019-01-25 | 上海电机学院 | 一种四驱轮式移动机器人轨迹跟踪控制方法 |
CN107272677B (zh) * | 2017-06-07 | 2020-12-11 | 东南大学 | 一种移动机器人的变结构自适应轨迹跟踪控制方法 |
CN108008720B (zh) * | 2017-10-31 | 2021-01-01 | 哈尔滨理工大学 | 一种轮式移动机器人的模糊滑模轨迹跟踪控制及方法 |
CN109960145B (zh) * | 2017-12-22 | 2022-06-14 | 天津工业大学 | 移动机器人混合视觉轨迹跟踪策略 |
CN107943056B (zh) * | 2017-12-25 | 2020-09-25 | 成都信息工程大学 | 基于查表法的不完整约束轮式机器人轨迹跟踪控制方法 |
CN108762274B (zh) * | 2018-06-06 | 2019-07-12 | 上海砾烽智能科技有限公司 | 一种移动机器人轨迹跟踪控制的方法 |
CN109031947A (zh) * | 2018-06-19 | 2018-12-18 | 哈尔滨理工大学 | 基于径向基神经网络的轨迹跟踪控制及方法 |
CN109062208B (zh) * | 2018-08-03 | 2021-08-10 | 合肥工业大学 | 一种不确定轮式移动机器人的自适应轨迹跟踪控制电路 |
CN109048907B (zh) * | 2018-08-23 | 2020-10-16 | 广东工业大学 | 消除惯量变化的机器人控制方法 |
CN109491389B (zh) * | 2018-11-23 | 2021-08-10 | 河海大学常州校区 | 一种具有速度约束的机器人轨迹跟踪方法 |
CN109782759B (zh) * | 2019-01-08 | 2021-11-02 | 华侨大学 | 一种轮式移动机器人的近似解耦、快速轨迹跟踪控制方法 |
CN109828528A (zh) * | 2019-01-21 | 2019-05-31 | 河北工业职业技术学院 | 机器人轨迹跟踪方法及装置 |
CN109648566B (zh) * | 2019-01-22 | 2021-07-30 | 天津大学 | 电机参数未知的全方位移动机器人的轨迹跟踪控制方法 |
CN109597310B (zh) * | 2019-02-01 | 2021-09-07 | 东南大学 | 一种基于扰动观测器的轮式移动机器人轨迹跟踪方法 |
CN110000782B (zh) * | 2019-04-01 | 2021-09-28 | 河海大学常州校区 | 一种基于滑模观测器的非完整机器人去抖控制方法 |
CN111699104A (zh) * | 2019-06-11 | 2020-09-22 | 深圳市大疆创新科技有限公司 | 可移动平台的控制方法、设备、可移动平台及存储介质 |
CN110231823B (zh) * | 2019-06-13 | 2020-07-14 | 中山大学 | 一种双轮机器人的直接控制方法 |
CN110601624B (zh) * | 2019-08-16 | 2020-11-17 | 南京埃斯顿自动化股份有限公司 | 一种伺服控制装置 |
CN111580512B (zh) * | 2020-04-28 | 2022-04-15 | 平安科技(深圳)有限公司 | 移动控制方法、装置、存储介质及计算机设备 |
CN111949036B (zh) * | 2020-08-25 | 2022-08-02 | 重庆邮电大学 | 一种轨迹跟踪控制方法、系统及两轮差速移动机器人 |
CN116382101B (zh) * | 2023-06-05 | 2023-09-01 | 成都信息工程大学 | 考虑不确定性的轮式移动机器人自适应控制方法及系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1877469A (zh) * | 2006-06-29 | 2006-12-13 | 上海电力学院 | 一种消弱滑模变结构控制系统抖振的方法 |
CN102591207A (zh) * | 2012-03-01 | 2012-07-18 | 北京航空航天大学 | 一种基于干扰观测器的柔性关节机械臂的滑模控制方法 |
CN103019239A (zh) * | 2012-11-27 | 2013-04-03 | 江苏大学 | 用于喷药移动机器人的轨迹跟踪滑模控制系统和控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2003096054A2 (en) * | 2002-05-10 | 2003-11-20 | Honda Giken Kogyo Kabushiki Kaisha | Real-time target tracking of an unpredictable target amid unknown obstacles |
US7720554B2 (en) * | 2004-03-29 | 2010-05-18 | Evolution Robotics, Inc. | Methods and apparatus for position estimation using reflected light sources |
-
2014
- 2014-11-11 CN CN201410631147.0A patent/CN104317299B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1877469A (zh) * | 2006-06-29 | 2006-12-13 | 上海电力学院 | 一种消弱滑模变结构控制系统抖振的方法 |
CN102591207A (zh) * | 2012-03-01 | 2012-07-18 | 北京航空航天大学 | 一种基于干扰观测器的柔性关节机械臂的滑模控制方法 |
CN103019239A (zh) * | 2012-11-27 | 2013-04-03 | 江苏大学 | 用于喷药移动机器人的轨迹跟踪滑模控制系统和控制方法 |
Non-Patent Citations (1)
Title |
---|
基于自适应模糊滑模控制器的非完整轮式移动机器人轨迹跟踪控制;陈浩;《中国优秀硕士学位论文全文数据库》;20140615;第2.3.1和2.3.2节,第3.3节,第4.4节 * |
Also Published As
Publication number | Publication date |
---|---|
CN104317299A (zh) | 2015-01-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104317299B (zh) | 一种基于轮式移动机器人轨迹跟踪的混合控制方法 | |
Chen et al. | RBFNN-based adaptive sliding mode control design for delayed nonlinear multilateral telerobotic system with cooperative manipulation | |
Hashemi et al. | Model-based PI–fuzzy control of four-wheeled omni-directional mobile robots | |
Safeea et al. | On-line collision avoidance for collaborative robot manipulators by adjusting off-line generated paths: An industrial use case | |
Li et al. | Continuous role adaptation for human–robot shared control | |
Wang et al. | A hybrid visual servo controller for robust grasping by wheeled mobile robots | |
Liu et al. | Algorithmic safety measures for intelligent industrial co-robots | |
Ajwad et al. | A comprehensive state-of-the-art on control of industrial articulated robots | |
Wen et al. | Elman fuzzy adaptive control for obstacle avoidance of mobile robots using hybrid force/position incorporation | |
Souzanchi-K et al. | Robust impedance control of uncertain mobile manipulators using time-delay compensation | |
Zhao et al. | Adaptive control and optimization of mobile manipulation subject to input saturation and switching constraints | |
Piltan et al. | Evaluation performance of 2nd order nonlinear system: Baseline control tunable gain sliding mode methodology | |
Surdilovic et al. | Development of collaborative robots (cobots) for flexible human-integrated assembly automation | |
Vick et al. | Safe physical human-robot interaction with industrial dual-arm robots | |
Chen et al. | Robust control for unmanned aerial manipulator under disturbances | |
Amoozgar et al. | Trajectory tracking of wheeled mobile robots: A kinematical approach | |
Nazemizadeh et al. | Trajectory planning of mobile robots using indirect solution of optimal control method in generalized point-to-point task | |
Moudoud et al. | Robust adaptive trajectory tracking control based on sliding mode of electrical wheeled mobile robot | |
Yu et al. | A haptic shared control algorithm for flexible human assistance to semi-autonomous robots | |
Wang | Fuzzy sliding mode joint impedance control for a tendon-driven robot hand performing peg-in-hole assembly | |
Xu et al. | Formation control of car-like autonomous vehicles under communication delay | |
Isma et al. | Time-dependant trajectory generation for tele-operated mobile manipulator | |
Yu et al. | Adaptive neural admittance control for collision avoidance in human-robot collaborative tasks | |
Mohan et al. | A null space control of an underactuated underwater vehicle-manipulator system under ocean currents | |
Shen et al. | Trajectory planning of omnidirectional mobile robots with active casters: Multi-motor coordination and singularity avoidance |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |