CN105607636B - 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 - Google Patents

一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 Download PDF

Info

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
Application number
CN201610041201.5A
Other languages
English (en)
Other versions
CN105607636A (zh
Inventor
冯宇
凌荣耀
郭军
郭一军
张文安
黄延昱
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang University of Technology ZJUT
Original Assignee
Zhejiang University of Technology ZJUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Zhejiang University of Technology ZJUT filed Critical Zhejiang University of Technology ZJUT
Priority to CN201610041201.5A priority Critical patent/CN105607636B/zh
Publication of CN105607636A publication Critical patent/CN105607636A/zh
Application granted granted Critical
Publication of CN105607636B publication Critical patent/CN105607636B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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>&amp;CenterDot;</mo> </mover> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>v</mi> <mi>i</mi> </msub> <msub> <mi>cos&amp;theta;</mi> <mi>i</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>y</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>v</mi> <mi>i</mi> </msub> <msub> <mi>sin&amp;theta;</mi> <mi>i</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>&amp;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>&amp;tau;</mi> <mo>=</mo> <msup> <mrow> <mo>&amp;lsqb;</mo> <msup> <mover> <mi>M</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mover> <mi>B</mi> <mo>&amp;OverBar;</mo> </mover> <mo>&amp;rsqb;</mo> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mo>&amp;lsqb;</mo> <msub> <mi>&amp;lambda;e</mi> <mn>1</mn> </msub> <mo>+</mo> <mover> <mi>V</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>&amp;rsqb;</mo> <mo>+</mo> <msup> <mrow> <mo>&amp;lsqb;</mo> <msup> <mover> <mi>M</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mover> <mi>B</mi> <mo>&amp;OverBar;</mo> </mover> <mo>&amp;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>&amp;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>&amp;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分别为机器人的期望速度向量和实际速度向量。
CN201610041201.5A 2016-01-21 2016-01-21 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 Active CN105607636B (zh)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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 北京印刷学院 一种基于信息物理网的车队编队控制装置及编队控制方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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