CN105607636B - 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 - Google Patents
一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 Download PDFInfo
- Publication number
- CN105607636B CN105607636B CN201610041201.5A CN201610041201A CN105607636B CN 105607636 B CN105607636 B CN 105607636B CN 201610041201 A CN201610041201 A CN 201610041201A CN 105607636 B CN105607636 B CN 105607636B
- Authority
- CN
- China
- Prior art keywords
- robot
- sliding mode
- slave
- formation
- integral sliding
- 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
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 24
- 238000000034 method Methods 0.000 title claims abstract description 17
- 230000000694 effects Effects 0.000 claims abstract description 8
- 230000014509 gene expression Effects 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 2
- 238000004891 communication Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process 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/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0291—Fleet control
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)
- Manipulator (AREA)
Abstract
一种基于积分滑模算法的轮式移动机器人主从式编队控制方法。1)建立每个机器人位姿的运动学方程;2)根据设定的期望距离和方向角计算从机器人的运动学控制律;3)基于步骤2)求得的运动学控制律,计算从机器人的动力学积分滑模控制律。该方法针对具有非完整约束的轮式移动机器人的主‑从结构编队问题给出了保证编队效果的动力学积分滑模控制律的设计方法,其中,主机器人起领航的作用,从机器人保持设定的期望距离和期望方向角跟随主机器人运动。所述编队控制方法快速、灵活,可以现实较好的编队控制效果且具有很强的鲁棒性。
Description
技术领域
本发明涉及自动化技术领域,具体涉及一种基于积分滑模算法的轮式移动机器人主从式编队控制方法。
背景技术
相比于单个机器人,多个机器人协同合作可以实现更复杂和重要的功能,随着网络通信和计算机技术的发展,多机器人协作***得到了越来越多的应用。编队控制是多机器人协作中的一类重要问题,它要求多个机器人在运动过程中根据具体任务需求保持期望的队形。特别的,轮式移动机器人在编队过程中易受路面状况、轮子滑动等外界干扰的影响且受到非完整约束,即移动机器人不能向车轮的轴向运动,因此,轮式移动机器人的编队控制作为一类具有特殊约束的非线性控制问题,其难点主要在于如何在实现控制效果的同时保证***的鲁棒性。
滑模控制算法快速、灵活,对非线性***可以现实较好的控制性能,且具有很强的鲁棒性,当***处于滑动模态,其对被控对象的建模误差、参数摄动和外部干扰具有极强的不敏感性。积分滑模控制算法在保持传统滑模控制算法优点的同时可以保证更好的跟踪精度。
发明内容
本发明要克服现有技术的上述缺点,针对具有非完整约束的轮式移动机器人,提出一种基于积分滑模算法的主从式编队控制方法。
本发明所述轮式移动机器人主从式编队如图1所示,考虑具有非完整约束的多个相同结构的轮式移动机器人,每个机器人前进、后退及旋转运动所需的力矩均由安装在同一轮轴上的两个车轮提供。考虑主-从结构的编队方式,其中,主机器人起领航的作用,从机器人保持期望距离Ls和期望方向角跟随主机器人运动。
具体实施步骤如下:
1)建立每个机器人位姿的运动学方程如下:
其中,vi和ωi分别表示第i个机器人的线速度和角速度,和分别表示第i个机器人的轮轴中心点在平面坐标系中的横坐标、纵坐标和方向角的导数。
2)根据设定的期望距离和方向角计算从机器人的运动学控制律,以线速度vu和角速度ωu作为从机器人的运动学控制输入,具体表达式如下:
其中,d是从机器人几何中心与轮轴中心的距离,标量kx,ky,kθ>0是用于调节跟踪速率和精度的控制器设计参数,ex,ey和eθ分别表示在从机器人坐标系中从机器人的横坐标、纵坐标和方向角与设定值之间的偏差,其具体表达式如下:
上式中,L和分别为主从机器人之间的实际距离和方向角,θlf=θl-θf,θl和θf分别是主机器人和从机器人在平面坐标系中的方向角。
3)基于步骤2)求得的运动学控制律,计算从机器人的动力学积分滑模控制律τ,其具体表达式如下:
其中,m是机器人的重量,I是机器人的惯量,r是车轮半径,R是二分之一的轮轴长度,K=diag(k1,k2),标量k1,k2>0和λ>0是用于调节控制效果的控制器设计参数,滑模变量s1和s2如下式所示:
其中V=[vs ωs]T,U=[v ω]T,vs和v分别为机器人的期望线速度和实际线速度,ωs和ω分别为机器人的期望角速度和实际角速度,表示V的导数,e1和e2为机器人的期望速度和实际速度之间的误差向量及其积分,sgn(·)表示符号函数。
本发明的优点是:所述编队控制方法快速、灵活,对非线性***可以现实较好的控制性能,且具有很强的鲁棒性。
附图说明
图1是本发明所述机器人编队***的结构图。
图2是本发明的机器人编队的控制效果图。
具体实施方式
为更直观的说明本发明的方案和优势,下面结合实施例对本发明的技术方案作进一步描述。参照图1、图2:
考虑由一个主机器人和两个从机器人组成的编队,各机器人的物理参数均为m=7kg,I=5kgm2,r=0.033m,R=0.161m。主机器人初始位置xl=3,yl=1,θl=0,初始线速度vl=4m/s,初始角速度ωl=1rad/s;从机器人1的初始位置xf1=2,yf1=2,θf1=0.1π,初始线速度和初始角速度为零,给定期望车距和方向角分别为1.5m,2π/3;从机器人2的初始位置xf2=2,yf2=-1.1,θf2=-π/9,初始线速度和初始角速度为零,给定期望车距和方向角分别为1.5m,-2π/3。
为了验证本发明所提控制方法的鲁棒性,生成时变信号w=[12sin(3.5t) 11cos(4t)]T作为扰动输入,从机器人1的控制器参数选取如下kx=20,ky=12,kθ=18,从机器人2的控制器参数选取如下kx=46,ky=16,kθ=18,编队效果如图2所示,两个从机器人与主机器人以较短的时间形成并保持了期望队形,表明本发明所提方法可以实现较好的控制效果。
Claims (1)
1.针对具有非完整约束的轮式移动机器人,提出一种基于积分滑模算法的主从式编队控制方法,编队过程中,主机器人起领航的作用,从机器人保持设定的期望距离Ls和期望方向角跟随主机器人运动,所述编队控制方法的特征在于该方法在实施过程中包括以下技术步骤:
1)建立每个机器人位姿的运动学方程如下:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<msub>
<mi>cos&theta;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>v</mi>
<mi>i</mi>
</msub>
<msub>
<mi>sin&theta;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>&omega;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,vi和ωi分别表示第i个机器人的线速度和角速度,xi,yi和θi分别为第i个机器人的轮轴中心点在平面坐标系中的横坐标、纵坐标和方向角;
2)根据设定的期望距离和方向角计算从机器人的运动学控制律,以线速度vu和方向角ωu作为从机器人的运动学控制输入,具体表达式如下:
其中,d是从机器人几何中心与轮轴中心的距离,vl表示主机器人的线速度,ωl表示主机器人的角速度,标量kx,ky,kθ>0是用于调节跟踪速率和精度的控制器设计参数,ex,ey和eθ分别表示在从机器人坐标系中从机器人的横坐标、纵坐标和方向角与设定值之间的偏差,其具体表达式如下:
上式中,L和分别为主从机器人之间的实际距离和方向角,θlf=θl-θf,θl和θf分别是主机器人和从机器人在平面坐标系中的方向角,θs表示从机器人坐标系中从机器人方向角的设定值;
3)基于步骤2)求得的运动学控制律,计算从机器人的动力学积分滑模控制律τ,其具体表达式如下:
<mrow>
<mi>&tau;</mi>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msup>
<mover>
<mi>M</mi>
<mo>&OverBar;</mo>
</mover>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mi>B</mi>
<mo>&OverBar;</mo>
</mover>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&lsqb;</mo>
<msub>
<mi>&lambda;e</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>&rsqb;</mo>
<mo>+</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msup>
<mover>
<mi>M</mi>
<mo>&OverBar;</mo>
</mover>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mi>B</mi>
<mo>&OverBar;</mo>
</mover>
<mo>&rsqb;</mo>
</mrow>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mi>K</mi>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>sgn</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>s</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sgn</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>s</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,m是机器人的重量,I是机器人的惯量,r是车轮半径,R是二分之一的轮轴长度,K=diag(k1,k2),标量k1,k2>0和λ>0是用于调节控制效果的控制器设计参数,滑模变量s1和s2如下式所示:
<mrow>
<mi>s</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>s</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>s</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&lambda;e</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mi>V</mi>
<mo>-</mo>
<mi>U</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>e</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msubsup>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>t</mi>
</msubsup>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
V=[vs ωs]T和U=[v ω]T分别为机器人的期望速度向量和实际速度向量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610041201.5A CN105607636B (zh) | 2016-01-21 | 2016-01-21 | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610041201.5A CN105607636B (zh) | 2016-01-21 | 2016-01-21 | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105607636A CN105607636A (zh) | 2016-05-25 |
CN105607636B true CN105607636B (zh) | 2018-03-02 |
Family
ID=55987633
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610041201.5A Active CN105607636B (zh) | 2016-01-21 | 2016-01-21 | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105607636B (zh) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106502091B (zh) * | 2016-10-19 | 2019-06-07 | 长春工业大学 | 一种车辆动力学控制的优化分配方法 |
CN106647771B (zh) * | 2017-01-24 | 2019-09-03 | 浙江工业大学 | 多移动机器人的最小步编队方法 |
CN107085432B (zh) * | 2017-06-22 | 2020-03-31 | 迪比(重庆)智能科技研究院有限公司 | 一种移动机器人的目标轨迹跟踪方法 |
CN107992035A (zh) * | 2017-11-15 | 2018-05-04 | 西北工业大学 | 一种基于室内全局定位的多移动机器人编队控制方法 |
CN108333949B (zh) * | 2018-03-09 | 2020-10-02 | 南京航空航天大学 | 针对多智能体***执行器失效故障的滑模容错控制方法 |
CN108614426B (zh) * | 2018-06-06 | 2021-03-16 | 黄山学院 | 一种基于干扰观测器的多移动机器人编队鲁棒控制方法 |
CN108614425B (zh) * | 2018-06-06 | 2021-03-16 | 黄山学院 | 移动机器人自适应积分滑模控制方法 |
CN108897321B (zh) * | 2018-07-16 | 2021-06-15 | 重庆理工大学 | 基于领航跟随法的机器人队形可变编队控制方法与控制器 |
CN108897224B (zh) * | 2018-08-03 | 2021-09-24 | 合肥工业大学 | 一种不确定轮式移动机器人的自适应轨迹跟踪控制方法 |
CN110083059B (zh) * | 2019-04-01 | 2022-04-22 | 河海大学常州校区 | 一种离散时间滑模的非完整机器人镇定控制方法 |
CN110000782B (zh) * | 2019-04-01 | 2021-09-28 | 河海大学常州校区 | 一种基于滑模观测器的非完整机器人去抖控制方法 |
CN110879599B (zh) * | 2019-12-12 | 2022-05-31 | 大连海事大学 | 一种基于有限时间扰动观测器的固定时间编队控制方法 |
CN111506114B (zh) * | 2020-05-25 | 2021-05-04 | 北京理工大学 | 一种飞行器编队控制方法 |
CN111966111B (zh) * | 2020-10-23 | 2021-06-08 | 北京国新智电新能源科技有限责任公司 | 基于自动配电的移动充电设备编队控制方法、***、装置 |
CN113377016B (zh) * | 2021-07-16 | 2022-08-30 | 黄山学院 | 考虑打滑的多移动机器人协同编队无抖振滑模控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104950672A (zh) * | 2015-06-10 | 2015-09-30 | 北京理工大学 | 一种最优积分滑模控制方法 |
CN105116900A (zh) * | 2015-08-28 | 2015-12-02 | 浙江工业大学 | 基于Nash迭代的分布式多移动机器人编队控制方法 |
CN105116899A (zh) * | 2015-08-28 | 2015-12-02 | 浙江工业大学 | 基于eso的分布式多移动机器人编队控制方法 |
CN105138044A (zh) * | 2015-07-10 | 2015-12-09 | 北京印刷学院 | 一种基于信息物理网的车队编队控制装置及编队控制方法 |
-
2016
- 2016-01-21 CN CN201610041201.5A patent/CN105607636B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104950672A (zh) * | 2015-06-10 | 2015-09-30 | 北京理工大学 | 一种最优积分滑模控制方法 |
CN105138044A (zh) * | 2015-07-10 | 2015-12-09 | 北京印刷学院 | 一种基于信息物理网的车队编队控制装置及编队控制方法 |
CN105116900A (zh) * | 2015-08-28 | 2015-12-02 | 浙江工业大学 | 基于Nash迭代的分布式多移动机器人编队控制方法 |
CN105116899A (zh) * | 2015-08-28 | 2015-12-02 | 浙江工业大学 | 基于eso的分布式多移动机器人编队控制方法 |
Non-Patent Citations (4)
Title |
---|
Adaptive Fuzzy Sliding-Mode Formation Controller Design for Multi-Robot Dynamic Systems;Chang Y H, Yang C Y, Chan W S, et al;《International Journal of Fuzzy Systems》;20140331;第16卷(第1期);全文 * |
Sliding-mode formation control for cooperative autonomous mobile robots;Defoort M, Floquet T, Kokosy A, et al;《IEEE Transactions on Industrial Electronics》;20081130;第55卷(第11期);全文 * |
多机器人的积分滑模编队控制;钱殿伟,等;《电机与控制学报》;20160115;第20卷(第1期);全文 * |
移动机器人导航中的轨迹跟踪与群集运动控制研究;张鑫;《万方学位论文数据库》;20121225;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN105607636A (zh) | 2016-05-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105607636B (zh) | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 | |
Sun et al. | Path-following control of Mecanum-wheels omnidirectional mobile robots using nonsingular terminal sliding mode | |
CN113311859B (zh) | 一种无人机集群有限时间仿射编队飞行控制方法 | |
Ghommam et al. | Formation path following control of unicycle-type mobile robots | |
CN113110495B (zh) | 一种考虑外部干扰下移动机器人的编队控制方法 | |
CN107831761A (zh) | 一种智能车的路径跟踪控制方法 | |
Wang et al. | Research on logistics autonomous mobile robot system | |
Low | A flexible leader-follower formation tracking control design for nonholonomic tracked mobile robots with low-level velocities control systems | |
Megalingam et al. | PID based locomotion of multi-terrain robot using ROS platform | |
Widyotriatmo et al. | Line following control of an autonomous truck-trailer | |
CN113848905B (zh) | 基于神经网络和自适应控制的移动机器人轨迹跟踪方法 | |
Bos et al. | MPC-based motion planning for autonomous truck-trailer maneuvering | |
Hamerlain et al. | Trajectory tracking of a car-like robot using second order sliding mode control | |
Wu et al. | Lateral position control for a tractor-trailer system using steering rate input | |
CN112051736B (zh) | 一种基于单控制器的轨迹跟踪控制*** | |
Miah et al. | Universal dynamic tracking control law for mobile robot trajectory tracking | |
CN104527780B (zh) | 一种四轮独立转向车辆的转向控制方法 | |
Dai et al. | Online path tracking and motion optimization of a 4WS4WD vehicle | |
CN117075525B (zh) | 基于约束型模型预测控制的移动机器人控制方法 | |
CN112327620B (zh) | 兼顾绕障的移动机器人鲁棒控制方法及*** | |
CN117850433B (zh) | 受扰通信受限移动机器人避撞编队控制方法和*** | |
CN117724471A (zh) | 一种基于速度反馈控制的移动机器人轨迹跟踪控制方法及*** | |
CN117002479B (zh) | 一种基于横摆角速度的履带式车辆轨迹跟踪方法 | |
Chen et al. | A Novel Iterative Learning-Model Predictive Control Algorithm for Accurate Path Tracking of Articulated Steering Vehicles | |
Duinkerken et al. | Developing an AGV motion controller using simulation, emulation and prototyping |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |