CN112684793A - 一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法 - Google Patents
一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN112684793A CN112684793A CN202011396172.7A CN202011396172A CN112684793A CN 112684793 A CN112684793 A CN 112684793A CN 202011396172 A CN202011396172 A CN 202011396172A CN 112684793 A CN112684793 A CN 112684793A
- Authority
- CN
- China
- Prior art keywords
- robot
- representing
- motion
- control
- axis
- 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.)
- Granted
Links
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明公开了一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法。该方法为:首先根据刚体运动学相关定理,对机器人的运动过程进行分解,并结合机器人实际的系统结构,建立机器人运动模型,并根据轨迹跟踪控制的概念,建立机器人运动过程中的误差模型;然后利用相关控制的思想,建立机器人轨迹跟踪控制的控制律;接着将机器人运动模型进行离散化处理,得到离散化后的机器人运动模型,并计算离散系统下机器人的运动误差模型;最后根据离散系统下机器人的运动误差模型对机器人轨迹跟踪控制的控制律进行针对离散系统的优化,得到优化后的轨迹跟踪控制量。本发明减小了机器人运动控制的计算量,提高了机器人的轨迹跟踪控制工作的效率和精确度。
Description
技术领域
本发明属于移动机器人运动控制技术领域,特别是一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法。
背景技术
随着近年来计算机领域相关技术的飞速发展,人工智能逐渐成为了全世界关注的焦点,其中机器人领域因其能直接造福人类的日常生活,正成为新的蓝海和重点发展方向。
在移动机器人的系统设计上,常见的移动机器人大都使用了非全向运动结构,采用差速的方式控制机器人运动,此时机器人通常使用原地转向模型进行转向。由于机器人的原地转向花费时间长,这种控制方式在机器人需要进行大量转向操作的场合会极大的降低机器人执行任务的效率。
为了提高机器人运行的效率,由独立驱动的四标准转向轮组成的非完整全向运动结构成为了当前室外全向全驱机器人结构的主要设计方案。而其运动控制方案,通常是利用机器人瞬时旋转中心建立机器人的运动学模型,使得机器人能连续运动,但该模型在过弯时需要知道瞬时旋转中心的位置,且在运动空间狭窄或需要完成直角轨迹时效果不佳。
同时,控制算法应是能够在实际系统中稳定有效的,而目前多数运动控制方案都没有考虑机器人控制系统离散化后给机器人运动控制所带来的偏差,这就导致根据连续系统得到的控制律在实际应用中会使轨迹追踪产生误差。
发明内容
本发明的目的在于提供一种能应用在实际的离散系统中、能够实现机器人在前进的同时以零半径过弯的轨迹跟踪控制方法。
实现本发明目的的技术解决方案为:一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法,包括以下步骤:
步骤1、根据刚体运动学相关定理,对机器人的运动过程进行分解,并结合机器人实际的系统结构,建立机器人运动模型;
步骤2、根据轨迹跟踪控制的概念,建立机器人运动过程中的误差模型;
步骤3、利用相关控制的思想,建立机器人轨迹跟踪控制的控制律;
步骤4、将步骤1中建立的机器人连续系统的运动模型进行离散化处理,得到离散化后的机器人运动模型;
步骤5、计算离散系统下机器人的运动误差模型;
步骤6、根据离散系统下机器人的运动误差模型对步骤3中得到的控制律进行针对离散系统的优化,得到优化后的轨迹跟踪控制量。
本发明与现有技术相比,其显著优点为:(1)利用刚体运动思想,使得机器人能够在运动空间受到严格限制的情况下,流畅高效地完成机器人的轨迹跟踪控制工作;(2)针对离散系统进行了优化设计,实现了对实际离散系统的精确控制,减低了对机器人控制系统设计实时性的要求;(3)减小了机器人运动控制的计算量,提高了计算效率。
附图说明
图1是本发明离散系统中的机器人零半径过弯的轨迹跟踪控制方法的流程示意图。
图2是本发明实施例中建立的机器人坐标系示意图。
图3是本发明实施例中控制系统离散化后未经速度修正前机器人实际轨迹与参考轨迹的跟踪效果曲线图。
图4是本发明实施例中控制系统离散化后经速度修正后机器人实际轨迹与参考轨迹的追踪效果曲线图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步的详细说明。
结合图1,本发明一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法,包括以下步骤:
步骤1、根据刚体运动学相关定理,对机器人的运动过程进行分解,并结合机器人实际的系统结构,建立机器人运动模型,具体如下:
如图2所示,以机器人中心位置为基点A,建立机器人随动右手坐标系Axyz以及机器人自身右手坐标系AXYZ,规定逆时针旋转方向为正方向,其中vA表示基点A的速度大小,θ表示A点速度与Ax轴的夹角,ω表示机器人绕A点旋转的角速度,表示机器人朝向与Ax轴的夹角;
利用夏莱定理对机器人的运动进行分解,得到机器人的运动学模型如下:
其中,xA表示机器人中心沿x轴运动的距离,和vAx表示机器人中心沿x轴的线速度;yA表示机器人中心沿x轴运动的距离,和vAy表示机器人中心沿y轴的线速度;表示机器人朝向与Ax轴的夹角,和ω都表示机器人绕A点旋转的角速度。
步骤2、根据轨迹跟踪控制的概念,建立机器人运动过程中的误差模型,具体如下:
其中θr表示参考点处机器人的平动方向,vr表示参考点处机器人的平动速度,ωr表示参考点处机器人的绕轴旋转速度;
对上式求导可得机器人运动过程中的误差模型如下:
其中,机器人参考轨迹在t时刻的全局坐标为此时机器人实际的坐标为位姿误差为xe表示机器人参考点和实际位置的x轴的位置偏差,表示机器人参考点和实际位置沿x方向的速度偏差,表示机器人参考点处的沿x轴的速度,表示机器人实际位置沿x轴的速度,vr表示参考点处机器人的平动速度,θr表示参考点处机器人的平动方向,vA表示基点A的速度大小,θ表示A点速度与Ax轴的夹角;ye表示机器人参考点和实际位置的y轴的位置偏差,表示机器人参考点和实际位置沿y轴的速度偏差,表示机器人参考点处的沿y轴的速度,表示机器人实际位置沿y轴的速度;表示朝向误差,表示机器人参考点和实际位置的角速度差,和ωr表示参考点处机器人的绕轴旋转速度,和ω表示机器人绕A点旋转的角速度。
步骤3、利用相关控制的思想,建立机器人轨迹跟踪控制的控制律,具体如下:
分析误差模型可以看到,利用刚体运动学进行分解后,机器人的平动和转动被解耦成了两个独立的运动,可以分别对其进行控制,平动来的控制目的是让坐标误差xe和ye趋近于0,而转动的控制目的则是使得朝向误差趋近于0。
根据上述分析可以设计机器人轨迹跟踪控制的控制律为:
其中,vAx表示机器人中心沿x轴的线速度,xe表示机器人参考点和实际位置的x轴的位置偏差,vr表示参考点处机器人的平动速度,θr表示参考点处机器人的平动方向;vAy表示机器人中心沿y轴的线速度,ye表示机器人参考点和实际位置的y轴的位置偏差;ω表示机器人绕A点旋转的角速度,表示朝向误差,ωr表示参考点处机器人的绕轴旋转速度;kv1、kv2分别为x、y方向平动系数,kω为转动系数,且kv1>0,kv2>0,kω>0。
进一步地,对给出控制律的稳定性进行检验。由于机器人的平动和转动是经过解耦的,因此分别对平动和转动进行稳定性分析。
构造平动的李雅普诺夫函数如下:
对上式求微分可得:
可知机器人的平动是李雅普诺夫稳定的,且
同理可证明机器人的转动也是李雅普诺夫稳定的,至此可证明所设计的控制律能够使机器人追踪给定的参考轨迹。
步骤4、将步骤1中建立的机器人连续系统的运动模型进行离散化处理,得到离散化后的机器人运动模型,具体如下:
设定描述机器人最小运动的时间间隔为δt,δt→0,控制系统更新的周期为Δt,轨迹参考点之间的时间间隔为T,且有Δt=ktδt,T=MΔt,kt>0,M>0。若在t时刻机器人的位姿为通过控制系统计算给出的控制变量为[vx(t) vy(t) ω(t)]T,则机器人在最小间隔内的位移为:
定义旋转变换R如下所示:
其中σ为旋转的角度,即σ>0表示逆时针旋转,σ<0表示顺时针旋转,该变换实现了将旋转了σ的坐标系变换到原坐标系的功能。
在t+δt时刻,t时刻所给定的控制变量随着机器人的运动发生了改变,即:
在t+Nδt时刻,N>0,由于δt很小,因此可以近似的将机器人的运动看作直线运动,有机器人的位姿的迭代公式:
化简可得离散化后的机器人的运动位置模型为:
步骤5、计算离散系统下机器人的运动误差模型,具体如下:
令t时刻步骤3给出控制量[vx(t) vy(t) ω(t)]T,由于其中的控制变量只与参考点处的位姿以及机器人的实际位姿有关,与参考点之间的运动无关,故在下一次机器人状态更新的时刻理想的机器人位姿应为:
可以得到离散系统下机器人的运动误差模型为:
步骤6、根据离散系统下机器人的运动误差模型对步骤3中得到的控制律进行针对离散系统的优化,得到优化后的轨迹跟踪控制量,具体如下:
可以看到,轨迹点之间机器人的朝向是没有偏差的,故控制器只需对机器人位置的误差进行补偿即可;而位置的误差产生的原因只与机器人的转动有关,因此控制器优化目标是通过设计机器人速度分量,使得控制系统能够只凭借根据控制变量所能得到的相关信息,减小由于系统离散化而给轨迹跟踪带来的误差。
令机器人状态更新的最小周期Δt=ktδt,故给出机器人速度的控制律如下:
可以得到机器人在t+(N+1)ktδt的位姿如下:
根据此时理想位姿可以得到修正后的位姿误差为:
在本实施实例中,机器人旋转的角速度ω(t)≤0.2rad/s,控制量更新周期Δt=0.1s,轨迹点出现的周期T=1s,故令N+1=T/Δt=10,则有:
显然经过修正后的速度能够在离散系统下有效的减小轨迹的误差,且修正效果随着角速度的增大以及轨迹点出现周期的增加越来越明显。
进一步地,步骤1中所述的机器人运动模型,包括机器人的运动学模型,还包括其他能够描述机器人运动状态的模型。
进一步地,步骤3中所述相关控制的思想,包括状态反馈控制方法、滑模控制方法、模糊控制方法、智能控制方法和鲁棒控制方法。
进一步地,步骤4中所述的连续系统,是指机器人控制系统在时域上的连续,即机器人的控制系统能够以忽略不计的时间间隔完成对机器人所有运动执行机构的控制;步骤4、5、6中的离散系统,是指机器人控制系统在时域上具有设定周期性,即机器人的控制系统按照设定的时间间隔完成对机器人所有运动执行机构的控制。
通过实物仿真验证控制效果,图3、图4分别展示了未针对离散化系统中速度修正时和针对离散化系统中速度修正后机器人实际轨迹与参考轨迹的误差,直线表示给定轨迹,虚线表示仿真轨迹,显然经过离散化修正的轨迹控制能够能更好的实现对实际轨迹的追踪工作。
Claims (10)
1.一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法,其特征在于,包括以下步骤:
步骤1、根据刚体运动学相关定理,对机器人的运动过程进行分解,并结合机器人实际的系统结构,建立机器人运动模型;
步骤2、根据轨迹跟踪控制的概念,建立机器人运动过程中的误差模型;
步骤3、利用相关控制的思想,建立机器人轨迹跟踪控制的控制律;
步骤4、将步骤1中建立的机器人连续系统的运动模型进行离散化处理,得到离散化后的机器人运动模型;
步骤5、计算离散系统下机器人的运动误差模型;
步骤6、根据离散系统下机器人的运动误差模型对步骤3中得到的控制律进行针对离散系统的优化,得到优化后的轨迹跟踪控制量。
2.根据权利要求1所述的离散系统中的机器人零半径过弯的轨迹跟踪控制方法,其特征在于,步骤1中所述的建立机器人运动模型,具体如下:
以机器人中心位置为基点A,建立机器人随动右手坐标系Axyz以及机器人自身右手坐标系AXYZ,规定逆时针旋转方向为正方向,其中vA表示基点A的速度大小,θ表示A点速度与Ax轴的夹角,ω表示机器人绕A点旋转的角速度,表示机器人朝向与Ax轴的夹角;
利用夏莱定理对机器人的运动进行分解,得到机器人的运动学模型如下:
3.根据权利要求1所述的离散系统中的机器人零半径过弯的轨迹跟踪控制方法,其特征在于,步骤2中所述的建立机器人运动过程中的误差模型,具体如下:
机器人运动过程中的误差模型为:
其中,机器人参考轨迹在t时刻的全局坐标为此时机器人实际的坐标为位姿误差为xe表示机器人参考点和实际位置的x轴的位置偏差,表示机器人参考点和实际位置沿x方向的速度偏差,表示机器人参考点处的沿x轴的速度,表示机器人实际位置沿x轴的速度,vr表示参考点处机器人的平动速度,θr表示参考点处机器人的平动方向,vA表示基点A的速度大小,θ表示A点速度与Ax轴的夹角;ye表示机器人参考点和实际位置的y轴的位置偏差,表示机器人参考点和实际位置沿y轴的速度偏差,表示机器人参考点处的沿y轴的速度,表示机器人实际位置沿y轴的速度;表示朝向误差,表示机器人参考点和实际位置的角速度差,和ωr表示参考点处机器人的绕轴旋转速度,和ω表示机器人绕A点旋转的角速度。
7.根据权利要求1所述的离散系统中的机器人零半径过弯的轨迹跟踪控制方法,其特征在于,步骤6所述的根据离散系统下机器人的运动误差模型对步骤3中得到的控制律进行针对离散系统的优化,得到优化后的轨迹跟踪控制量,具体如下:
由于轨迹点之间机器人的朝向没有偏差,故控制器只需对机器人位置的误差进行补偿即可;而位置的误差产生的原因只与机器人的转动有关,因此控制器优化目标是通过设计机器人速度分量,使得控制系统能够只凭借根据控制变量所能得到的相关信息,减小由于系统离散化而给轨迹跟踪带来的误差。
8.根据权利要求1所述的离散系统中的机器人零半径过弯的轨迹跟踪控制方法,其特征在于,步骤1中所述的机器人运动模型,包括机器人的运动学模型,还包括其他能够描述机器人运动状态的模型。
9.根据权利要求1所述的离散系统中的机器人零半径过弯的轨迹跟踪控制方法,其特征在于,步骤3中所述相关控制的思想,包括状态反馈控制方法、滑模控制方法、模糊控制方法、智能控制方法和鲁棒控制方法。
10.根据权利要求1所述的离散系统中的机器人零半径过弯的轨迹跟踪控制方法,其特征在于,步骤4中所述的连续系统,是指机器人控制系统在时域上的连续,即机器人的控制系统能够以忽略不计的时间间隔完成对机器人所有运动执行机构的控制;步骤4、5、6中的离散系统,是指机器人控制系统在时域上具有设定周期性,即机器人的控制系统按照设定的时间间隔完成对机器人所有运动执行机构的控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011396172.7A CN112684793B (zh) | 2020-12-03 | 2020-12-03 | 一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011396172.7A CN112684793B (zh) | 2020-12-03 | 2020-12-03 | 一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112684793A true CN112684793A (zh) | 2021-04-20 |
CN112684793B CN112684793B (zh) | 2022-06-28 |
Family
ID=75445763
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011396172.7A Active CN112684793B (zh) | 2020-12-03 | 2020-12-03 | 一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112684793B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114211173A (zh) * | 2022-01-27 | 2022-03-22 | 上海电气集团股份有限公司 | 一种确定焊接位置的方法、装置及系统 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007249363A (ja) * | 2006-03-14 | 2007-09-27 | Toyota Motor Corp | 移動体の軌道追従制御システム及び軌道追従制御方法 |
US20110231050A1 (en) * | 2010-03-22 | 2011-09-22 | Goulding John R | In-Line Legged Robot Vehicle and Method for Operating |
CN107168340A (zh) * | 2017-07-11 | 2017-09-15 | 江南大学 | 一种基于滑模变结构的移动机器人轨迹跟踪控制方法 |
CN108681243A (zh) * | 2018-05-03 | 2018-10-19 | 南京理工大学 | 一种机器人轨迹跟踪方法 |
CN108803601A (zh) * | 2018-05-31 | 2018-11-13 | 浙江工业大学 | 一种具有通信约束的移动机器人鲁棒预测跟踪控制方法 |
CN108897217A (zh) * | 2018-07-04 | 2018-11-27 | 西北工业大学 | 一种基于模型预测控制的欠驱动水面船轨迹跟踪控制方法 |
CN109799814A (zh) * | 2018-12-29 | 2019-05-24 | 中国北方车辆研究所 | 基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法 |
CN109885052A (zh) * | 2019-02-26 | 2019-06-14 | 华南理工大学 | 基于全向移动机器人运动学建模的误差模型预测控制方法 |
CN109960150A (zh) * | 2019-03-30 | 2019-07-02 | 南京理工大学 | 巡检机器人轨迹跟踪控制方法 |
CN111324146A (zh) * | 2020-03-09 | 2020-06-23 | 河海大学常州校区 | 一种水下巡检机器人的轨迹跟踪控制方法 |
-
2020
- 2020-12-03 CN CN202011396172.7A patent/CN112684793B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007249363A (ja) * | 2006-03-14 | 2007-09-27 | Toyota Motor Corp | 移動体の軌道追従制御システム及び軌道追従制御方法 |
US20110231050A1 (en) * | 2010-03-22 | 2011-09-22 | Goulding John R | In-Line Legged Robot Vehicle and Method for Operating |
CN107168340A (zh) * | 2017-07-11 | 2017-09-15 | 江南大学 | 一种基于滑模变结构的移动机器人轨迹跟踪控制方法 |
CN108681243A (zh) * | 2018-05-03 | 2018-10-19 | 南京理工大学 | 一种机器人轨迹跟踪方法 |
CN108803601A (zh) * | 2018-05-31 | 2018-11-13 | 浙江工业大学 | 一种具有通信约束的移动机器人鲁棒预测跟踪控制方法 |
CN108897217A (zh) * | 2018-07-04 | 2018-11-27 | 西北工业大学 | 一种基于模型预测控制的欠驱动水面船轨迹跟踪控制方法 |
CN109799814A (zh) * | 2018-12-29 | 2019-05-24 | 中国北方车辆研究所 | 基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法 |
CN109885052A (zh) * | 2019-02-26 | 2019-06-14 | 华南理工大学 | 基于全向移动机器人运动学建模的误差模型预测控制方法 |
CN109960150A (zh) * | 2019-03-30 | 2019-07-02 | 南京理工大学 | 巡检机器人轨迹跟踪控制方法 |
CN111324146A (zh) * | 2020-03-09 | 2020-06-23 | 河海大学常州校区 | 一种水下巡检机器人的轨迹跟踪控制方法 |
Non-Patent Citations (1)
Title |
---|
沈智鹏: "带扰动补偿的移动机器人轨迹跟踪反演控制", 《控制工程》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114211173A (zh) * | 2022-01-27 | 2022-03-22 | 上海电气集团股份有限公司 | 一种确定焊接位置的方法、装置及系统 |
CN114211173B (zh) * | 2022-01-27 | 2024-05-31 | 上海电气集团股份有限公司 | 一种确定焊接位置的方法、装置及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN112684793B (zh) | 2022-06-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111941421B (zh) | 一种基于多机器人协同操作的自适应模糊力跟踪控制方法 | |
CN113601512B (zh) | 一种机械臂奇异点的通用规避方法与系统 | |
CN110948504B (zh) | 机器人加工作业法向恒力跟踪方法和装置 | |
CN113110495B (zh) | 一种考虑外部干扰下移动机器人的编队控制方法 | |
Fan et al. | Data-driven motion-force control scheme for redundant manipulators: A kinematic perspective | |
CN107092266B (zh) | 一种移动车轨迹跟踪控制方法 | |
CN109782759B (zh) | 一种轮式移动机器人的近似解耦、快速轨迹跟踪控制方法 | |
CN108381555B (zh) | 一种飞行作业机器人冗余度机械臂下位控制器的设计方法 | |
CN112578671B (zh) | 一种基于u模型优化smc的agv轨迹跟踪控制方法 | |
CN109857100B (zh) | 一种基于反演法和快速终端滑模的复合轨迹跟踪控制算法 | |
CN109739094A (zh) | 一种基于自适应滑模控制的移动机器人轨迹跟踪新方法 | |
CN107160401B (zh) | 一种解决冗余度机械臂关节角偏移问题的方法 | |
CN108427282A (zh) | 一种基于示教学习的机器人逆运动学求解方法 | |
Ren et al. | Integrated task sensing and whole body control for mobile manipulation with series elastic actuators | |
CN114779785A (zh) | 一种基于pso参数整定的移动机器人平滑轨迹规划方法 | |
CN112706165A (zh) | 一种面向轮式移动机械臂的跟踪控制方法及系统 | |
CN112947430B (zh) | 一种移动机器人的智能轨迹跟踪控制方法 | |
CN108189034A (zh) | 一种机器人连续轨迹实现方法 | |
CN112684793B (zh) | 一种离散系统中的机器人零半径过弯的轨迹跟踪控制方法 | |
CN114721275A (zh) | 一种基于预设性能的视觉伺服机器人自适应跟踪控制方法 | |
CN111830832B (zh) | 仿生滑翔机器海豚平面路径跟踪方法及系统 | |
CN112650217A (zh) | 一种基于评估函数的机器人轨迹跟踪策略动态优化方法 | |
CN107085432B (zh) | 一种移动机器人的目标轨迹跟踪方法 | |
CN114055467B (zh) | 基于五自由度机器人的空间位姿在线仿真系统 | |
CN114131617A (zh) | 一种工业机器人的智能柔顺控制方法和装置 |
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 |