一种机器人轨迹跟踪方法技术

本发明专利技术涉及一种机器人轨迹跟踪方法。将机器人的离散运动轨迹作为跟踪轨迹，根据跟踪轨迹计算机器人坐标系中的机器人位姿误差，根据本发明专利技术设计的控制律计算跟踪速度，根据跟踪速度预估下一时刻的机器人全局位姿，然后计算出预估全局位姿与目标位姿的误差，根据用评价函数计算误差评价值，寻找评价值最低的速度作为当前时刻实际的跟踪速度。本发明专利技术基于Lyapunov函数构造控制律，能够同时跟踪机器人的位置和姿态；同时，本发明专利技术通过引入动态窗口确定参数，提高了跟踪的动态性能，跟踪曲线更贴合、更平滑。

【技术实现步骤摘要】
一种机器人轨迹跟踪方法
本专利技术属于机器人导航与控制
，具体涉及一种机器人轨迹跟踪方法。
技术介绍
机器人在实际运动控制过程中总会产生误差，或者是由于其他原因导致机器人在一定程度上偏离了设定的位置或姿态。如何发布速度指令以使得机器人能够良好地跟踪给定的路径或轨迹是解决误差时需要考虑的重要问题之一。跟踪控制包括路径跟踪和轨迹跟踪，前者跟踪的目标主要通过几何路径的方式表达，后者则通过各状态的时间函数表达。相比路径表达式，轨迹函数不仅包含了路径信息，而且隐含了目标机器人的速度信息，轨迹跟踪问题所研究的内容比路径跟踪问题更为丰富，也更为困难，但其研究的意义也更大。目前的跟踪控制算法一般基于非线性控制理论，如预测控制、模糊控制，或者几何因素，如纯追踪(purepursuit)算法。常用的控制器包括传统及改进的PID控制器和基于Lyapunov函数构造的控制器。传统的跟踪控制算法大多只能单独跟踪位置或姿态，难以在跟踪位置的同时跟踪机器人的位姿。另外，传统跟踪控制算法的稳定性和动态性能并不理想，不能满足较高要求的跟踪控制。
技术实现思路
本专利技术的目的在于提供一种机器人轨迹跟踪方法，基于Lyapunov函数构造控制律，能够同时跟踪机器人的位置和姿态；同时，本专利技术通过引入动态窗口确定参数，提高了跟踪的动态性能，跟踪曲线更贴合、更平滑。为了解决上述技术问题，本专利技术提供一种机器人轨迹跟踪方法，步骤如下：步骤1，将机器人的离散运动轨迹作为跟踪轨迹(xd(nT),yd(nT),θd(nT))，其中，T为采样时间，xd(nT)、yd(nT)和θd(nT))分别表示第nT时刻机器人离散运动轨迹中机器人位姿的横坐标、纵坐标和角度；步骤2，按照下式计算机器人坐标系中的机器人位姿误差(xe(nT),ye(nT),θe(nT))，其中，x(nT),y(nT),θ(nT)分别为第nT时刻机器人在全局坐标下的横坐标、纵坐标和角度；步骤3，按照下式所示的控制律，计算跟踪速度(vj(nT),ωj(nT))，其中，vd(nT)和ωd(nT)分别表示机器人在第nT时刻的线速度和角速度；vj(nT),ωj(nT)分别为，在第nT时刻，机器人控制器参数为αj时，控制器给出的线速度和角速度；设参数间隔i，0<i<1，以i为间隔遍历；设控制器参数α，将第j个α的取值记作αj，即α1＝i,α2＝2i,...,直到小于1的最大的α值；步骤4，根据跟踪速度(vj(nT),wj(nT))，按下式预估(nT+T)时刻的机器人全局位姿其中，分别为机器人在(nT+T)时刻应当达到的全局坐标系下的横坐标、纵坐标和角度，xg(nT),yg(nT),θg(nT)分别为nT时刻机器人的全局位姿，即机器人在nT时刻在全局坐标系下的实际横坐标、纵坐标和角度；步骤5、按下式计算预估在当前控制器下，在(nT+T)时刻机器人预估全局位姿与目标位姿的误差步骤6、根据误差用评价函数f(vj(nT),ωj(nT))计算其评价值，寻找评价值最低的速度作为nT时刻实际的跟踪速度，进一步，所述步骤2中，按下式计算第nT时刻的线速度vd(nT)和角速度ωd(nT)，进一步，所述步骤2中，根据连续轨迹(xd(t),yd(t),θd(t))按下式计算连续速度函数(vd(t),ωd(t))，然后再离散化得到第nT时刻的线速度vd(nT)和角速度ωd(nT)，其中，xd(t)'、yd(t)'、θd(t)'分别为横坐标函数、纵坐标函数和角度函数对时间的求导。本专利技术与现有技术相比，其显著优点在于：1、本专利技术基于Lyapunov函数构造的控制律，保证了轨迹跟踪的稳定性；2、基于轨迹跟踪，本专利技术能够同时跟踪机器人的位置和姿态；3、引入动态窗口思想确定控制器参数，提高了跟踪的动态性能，跟踪曲线更贴合、更平滑。附图说明图1为本专利技术机器人轨迹跟踪模型示意图；图2为本专利技术机器人轨迹跟踪方法流程图；图3为本专利技术机器人轨迹跟踪方法跟踪圆形变速轨迹的效果图；图4为本专利技术机器人轨迹跟踪方法跟踪圆形变速轨迹的误差图。具体实施方式容易理解，依据本专利技术的技术方案，在不变更本专利技术的实质精神的情况下，本领域的一般技术人员可以想象出本专利技术机器人轨迹跟踪方法的多种实施方式。因此，以下具体实施方式和附图仅是对本专利技术的技术方案的示例性说明，而不应当视为本专利技术的全部或者视为对本专利技术技术方案的限制或限定。本专利技术基本原理：如图1所示，在实际机器人的机器人坐标系中定义位姿误差，其在全局坐标系中的计算公式为：其中，(x,y,θ)为机器人在全局坐标中实际位姿的横坐标、纵坐标和角度，(xd,yd,θd)为指定轨迹目标位姿的横坐标、纵坐标和角度，(xe,ye,θe)表示机器人实际位姿与轨迹目标位姿在机器人坐标系下的误差，即以机器人横纵坐标为原点，角度方向为正方向，两者横纵坐标和角度的差值。可以将轨迹跟踪的问题转换为一个针对系统误差的镇定问题，即设计一个控制器，使得系统在平衡的(0,0,0)附近稳定，亦即其中，v为机器人线速度，ω为机器人角速度。针对该系统设计Lyapunov函数：易证，当且仅当xe2+ye2+θe2＝0时，V＝0；对V>0；当xe→∞||ye→∞||θe→∞时，V→∞。如果能设计控制器使得则系统是稳定的。推导易得如式：设计控制器如式：可得：如果另vd>0,0<α<1。则有且当xe→∞||ye→∞||θe→∞时，此时可证结合附图，本专利技术机器人轨迹跟踪方法包括以下步骤：步骤1、给定机器人的离散运动轨迹，或者对机器人的连续运动轨迹离散化，作为机器人的目标跟踪轨迹xd(nT),yd(nT),θd(nT)。其中T为采样时间，(xd(nT),yd(nT),θd(nT))表示在第n个序列，即第nT时刻离散运动轨迹规定的机器人目标位姿的横坐标、纵坐标和角度；步骤2、由离散运动轨迹计算离散速度函数，或者由连续运动轨迹求导计算连续速度函数，再离散化得到离散速度函数vd(nT),ωd(nT)，其中T为采样时间，vd(nT),ωd(nT)表示目标机器人在第n个序列，即第nT时刻，应该达到的线速度和角速度；步骤3、按下式，在机器人坐标系中计算位姿误差(xe(nT),ye(nT),θe(nT))，其中，T为采样时间，(x(nT),y(nT),θ(nT))为第n个序列，即nT时刻机器人的实际位姿，x(nT),y(nT),θ(nT)分别为nT时刻机器人在全局坐标下的横坐标、纵坐标和角度；步骤4、根据系统性能和实时性要求，选择合适的参数间隔i(0<i<1)，以i为间隔遍历，选取控制器参数α，将第j个α取值记作αj，即α1＝i,α2＝2i,...,直到小于1的最大的α值，并按下式构建控制律，计算相应的跟踪速度vj(nT),ωj(nT)，其中T为采样时间，vj(nT),ωj(nT)表示目标机器人在控制器参数取αj时，在第n个nT时刻，控制器给出的线速度和角速度：步骤5、根据跟踪速度vj(nT),wj(nT)，按下式预估相应的下一时刻，即(nT+T)时刻的机器人全局位姿即在参数为αj的控制器下，机器人在(nT+T)时刻理论达到的全局坐标系下的横坐标、纵坐标和角度：其中本文档来自技高网...

【技术保护点】
1.一种机器人轨迹跟踪方法，其特征在于，步骤如下：步骤1，将机器人的离散运动轨迹作为跟踪轨迹(xd(nT),yd(nT),θd(nT))，其中，T为采样时间，xd(nT)、yd(nT)和θd(nT))分别表示第nT时刻机器人离散运动轨迹中机器人位姿的横坐标、纵坐标和角度；步骤2，按照下式计算机器人坐标系中的机器人位姿误差(xe(nT),ye(nT),θe(nT))，

【技术特征摘要】
1.一种机器人轨迹跟踪方法，其特征在于，步骤如下：步骤1，将机器人的离散运动轨迹作为跟踪轨迹(xd(nT),yd(nT),θd(nT))，其中，T为采样时间，xd(nT)、yd(nT)和θd(nT))分别表示第nT时刻机器人离散运动轨迹中机器人位姿的横坐标、纵坐标和角度；步骤2，按照下式计算机器人坐标系中的机器人位姿误差(xe(nT),ye(nT),θe(nT))，其中，x(nT),y(nT),θ(nT)分别为第nT时刻机器人在全局坐标下的横坐标、纵坐标和角度；步骤3，按照下式所示的控制律，计算跟踪速度(vj(nT),ωj(nT))，其中，vd(nT)和ωd(nT)分别表示机器人在第nT时刻的线速度和角速度；vj(nT),ωj(nT)分别为，在第nT时刻，机器人控制器参数为αj时，控制器给出的线速度和角速度；设参数间隔i，0<i<1，以i为间隔遍历；设控制器参数α，将第j个α的取值记作αj，即α1＝i,α2＝2i,...,直到小于1的最大的α值；步骤4，根据跟踪速度(vj(nT),wj(nT)...

【专利技术属性】
技术研发人员：郭健，刘源，袁佳泉，李胜，吴益飞，洪宇，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏,32