CN104834309A - 基于目标跟踪控制策略的单移动机器人最优巡回控制方法 - Google Patents
基于目标跟踪控制策略的单移动机器人最优巡回控制方法 Download PDFInfo
- Publication number
- CN104834309A CN104834309A CN201510167059.4A CN201510167059A CN104834309A CN 104834309 A CN104834309 A CN 104834309A CN 201510167059 A CN201510167059 A CN 201510167059A CN 104834309 A CN104834309 A CN 104834309A
- Authority
- CN
- China
- Prior art keywords
- robot
- task
- optimal path
- path
- impact point
- 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
Abstract
一种基于目标跟踪控制策略的单移动机器人最优巡回控制方法,包括地图构建、任务描述、拓扑构建、路径寻优、任务分解、目标跟踪控制和位姿信息反馈7个步骤。首先,基于线性时序逻辑理论,将构建的加权切换系统与线性时序逻辑任务公式相融合,构建任务可行网络拓扑;然后,采用基于Dijkstra算法的路径寻优方法搜索出最优路径,并将环境中对应最优路径上的离散坐标点存储在缓存中,之后按序发送给目标跟踪控制器;然后,采用目标跟踪控制方法,根据机器人与目标点之间距离和角度的偏差,给出控制量控制机器人向目标点运行;最后,在机器人运行过程中,采用全局摄像头实时获取机器人当前的位置坐标和朝向信息,并反馈给目标跟踪控制器,从而实现闭环控制。
Description
技术领域
本系统涉及计算机图像处理、路径规划、移动机器人控制、通信等领域,尤其涉及一种基于目标跟踪控制策略的单移动机器人最优巡回控制方法。
背景技术
指示、规划、控制机器人以代替人类工作是目前工业自动控制领域的难点之一,近年来已受到了广泛的关注。机器人控制的主要目标是采用高级的近似人类逻辑的语言向机器人指示任务,使机器人在客观限制条件下自主将高级语言转换成低级的原始命令来完成任务,其中原始命令包括根据反馈控制器建立输入输出之间的对应关系,根据通信协议完成机器人个体之间或机器人与服务器之间的信息交换等,客观限制条件包括机器人自身的限制及外界物理环境对机器人的限制,机器人自身的限制包括机械限制、能量限制、计算能力及感知能力限制、通信范围的限制等,环境限制包括各种形状的障碍物及动态目标等。
对单移动机器人的控制包括上层的路径规划和基于规划路径的底层运动控制。传统的机器人路径规划方法主要针对“从A到B并避开障碍物”这种简单的点到点任务,而无法完成诸如“顺序访问A、B两点,然后巡回C、D两点”这类包含复杂巡回任务的最优路径规划。此外,传统的机器人运动控制方法主要集中在模糊控制、基于视觉的导航控制、学习控制、基于红外循迹控制等方法。其中,模糊控制需要根据经验和实验数据来制定控制策略,精度不高,自适应能力有限;基于视觉的导航控制需要实时采集并处理图像数据,处理的数据量大,对于光源、算法和硬件配置的效率要求较高;学习控制通用性差,机器学习与参数的调整是一个较为复杂的过程,性能较差;基于红外寻迹的移动机器人控制算法对光线有着特别的要求,而且需要给定红外识别对象,适用范围局限。基于目标跟踪控制策略的单移动机器人最优巡回控制方法的机器人运动控制采用了目标跟踪控制策略,区别于诸如模糊控制等传统的机器人控制策略,目标跟踪控制策略控制具有精度高、适用范围广、扩展性强、实现方便等优点,使得移动机器人能够实现最优路径的准确跟踪,从而更有效地完成复杂的巡回任务。
基于目标跟踪控制策略的单移动机器人最优巡回控制方法可以广泛的应用于如机器人排障、工厂等特殊环境的巡回监测、火灾救灾等实际应用中,实现机器人替人,从而降低任务风险,减少损失,提高工作效率。
发明内容
本发明要克服现有机器人路径规划及控制方法存在的上述缺点,提出一种基于目标跟踪控制策略的、高精度、适应性广、高效的单移动机器人最优巡回控制方法,包括基于线性时序逻辑的上层路径寻优和基于寻优路径的底层运动控制。首先,上层采用基于线性时序逻辑的最优路径规划方法规划出满足任务需求的最优路径,然后底层采用目标跟踪控制策略实现路径跟踪控制,同时结合实时的机器人位姿反馈信息(机器人的位置坐标和朝向信息)及时校准机器人的运动,实现闭环控制。
本发明解决其技术问题所采用的技术方案是:
一种基于目标跟踪控制策略的单移动机器人最优巡回控制方法,包括地图构建、任务描述、拓扑构建、路径寻优、任务分解、目标跟踪控制和位姿信息反馈7个步骤,其特征在于:首先,对输入的环境信息进行建模,构建加权切换系统模型,同时输入描述任务需求的线性时序任务公式,并进行转换,输出任务图表;其次,将加权切换系统模型和任务图表进行融合,构建任务可行网络拓扑;接着,采用基于Dijkstra算法的最优路径搜索算法在任务可行网络拓扑上搜索出满足任务需求的最优路径,并将任务可行网络拓扑上的最优路径映射回加权切换系统模型,获得环境中满足任务需求的最优路径;之后,将实际环境中对应最优路径上的离散坐标点存储在缓存中,并结合当前任务完成情况,按序读取缓存中的目标点;然后,采用目标跟踪控制策略,结合目标点坐标信息和实时反馈的机器人位置与朝向信息,根据机器人与目标点之间的距离和角度的偏差给出控制量,控制机器人完成最优路径跟踪;最后,实时采集机器人当前运行环境的图像信息,通过色块识别的方法,采用UDP通信的方式,反馈回机器人当前的位置坐标和朝向信息,具体实现步骤如下:
步骤1,地图构建
将机器人当前运行环境构建为加权切换系统模型;将移动机器人所在的运行环境划分为有限多个方块区域,每个独立的区域用字母qi∈Q表示,其中i∈{1,2,3,...},Q是区域的集合,Q0表示机器人的初始位置,机器人在环境中的移动对应区域的变化,表示为→;从一个区域到相邻区域的移动距离或是机器人移动的成本(权值),表示为ω,移动机器人在特定区域所执行的任务表示为πi∈Π,其中i∈{1,2,3,...},Π是所有任务的集合;如此构成一个转换系统模型,用字母T表示:T=(Q,Q0,→,Π,ω);
步骤2,任务描述
采用线性时序逻辑语言来描述指定任务,以线性时序任务公式的形式表达任务需求,并将任务公式转换为任务图表;线性时序逻辑语言产生的表达式基于切换系统的任务集合πi∈Π,线性时序逻辑语言的语法包括如下:线性时序逻辑语言的谓词包括(非)、∨(或)、∧(与)、□(全局)、◇(最终)、U(直到);用线性时序逻辑语言表述的任务需求用字母φ表示,φ是由切换系统模型中的子任务πi∈Π和谓词所组成的表达式:假设φ1和φ2为两个任务需求,φ1表示不能执行φ1,φ1∧φ2表示执行φ2同时避免执行φ1,φ1∧(□φ2)表示执行φ1和φ2并最终执行φ2,(◇□φ1)∧(◇□φ2)表示循环执行φ1和φ2;采用线性时序逻辑语言表述的移动机器人巡回任务为:
(◇□O)∧(◇□q1)∧(◇□q2)∧(◇□q3)∧...
其中,O为机器人运行环境中需要全局避开的区域,qi∈Q为环境中需要巡回的节点;在获得任务表达式后,采用LTL2BA工具箱将任务表达式φ转换成对应的Büchi自动机,Büchi自动机是可判断输入的路径序列是否满足任务需求的图表,用字母B表示:B=(S,S0,∑B,δB,F),其中S是有限状态集合,是初始状态集合,∑B是输入字母表,δB是转换函数,是最终状态集合;Büchi自动机可以保证路径满足任务需求;
步骤3,拓扑构建
将加权切换系统模型和任务图表相融合构建任务可行网络拓扑;把输入的加权切换系统模型T与任务图表B作笛卡尔乘积,得到任务可行网络拓扑,用字母P表示,即P=T×B,其中T=(Q,Q0,→,Π,ω),B=(S,S0,∑B,δB,F),P=(SP,Sp0,→P,FP),SP=Q×S为有限状态集合,Sp0=Q0×S0为初始状态集合,为转换函数,FP=Q×F为最终状态集合;在任务可行网络拓扑上所包含的路径,既满足指定的任务需求,又符合机器人当前的运行环境;
步骤4,路径寻优
采用基于Dijkstra算法的最优路径搜索算法,根据线性时序逻辑任务公式中要求访问节点的出现顺序,在任务可行网络拓扑上搜索出最优路径,然后任务可行网络拓扑上的最优路径映射回加权切换系统模型上,获得实际环境中的最优路径;其中,搜索所得的最优路径为一个机器人运行环境中最优路径上对应的离散坐标点集;
步骤5,任务分解
将步骤4所得的最优路径存入缓存,并结合当前任务完成情况(已访问的点),按序将离散坐标点集中的坐标信息发送给目标跟踪控制器,用以控制机器人实现路径跟踪,直到遍历离散坐标点集中的所有点,以确保机器人完成完整的路径跟踪;
步骤6,目标跟踪控制
结合步骤5给出的目标点坐标(x*,y*)和实时反馈的机器人当前位置坐标(x,y),根据两轮差动机器人运动学特性,可以得到机器人到目标点的距离偏差r为:
根据全局摄像头实时采集的机器人上前后两个不同颜色的色块中心点坐标信息,换算得到坐标系X轴的正方向按顺时针旋转到机器人正面朝向所经过的角度θ,从而可以得到机器人与目标点之间的角度偏差φ为:
其中,可表示为:
根据上述获得的机器人与目标点之间的距离偏差r和角度偏差φ,采用具有如下形式的控制器,获得机器人的线速度和转动速度
υ=K1rcos(φ)
ω=-K1sin(φ)cos(φ)-K2φ
其中,K1和K2为控制参数,υ为机器人向前运行的速度,ω表示机器人转向时的角速度;然后,再根据两轮差动机器人的运动学特性得到移动机器人左右两轮的控制量为:
其中,υL和υR分别表示机器人的左右两轮速度,d为机器人左右两轮之间的距离;在控制量υL和υR的作用下,移动机器人朝着给定的目标点运行。
由上述υL和υR两式可以看出υ部分引导机器人向目标点运动,对保证机器人电机的正常运行至关重要;ω部分控制机器人正面朝向目标点,即将φ逐渐调整为0;K2可调节机器人转向的灵敏度,因此当K1和K2差值过大时机器人将产生很高的角速度,在有限的采样速率下,将导致控制量不能及时修正而造成超调,导致机器人蛇形前进,影响控制效果,因此控制参数K1和K2取值的差值不可过大。此外,目标跟踪控制器能够控制机器人实现目标跟踪,也就意味着,在有限的时间内,机器人到目标点的距离r和机器人与目标点之间的角度偏差φ能够收敛到0。因此,构造李雅普诺夫能量函数:
求导可得:
其中,和由对r和φ两式求导所得:
根据李雅普诺夫稳定性判据可知当K1>0且K2>0时,即理论能上只要控制参数K1和K2为正,则所设计的目标跟踪控制策略就可以引导机器人至目标点;
步骤7,位姿信息反馈
在机器人运行过程中,采用全局相机实时采集机器人当前运行环境的图像信息,通过图像处理记录并显示机器人的运行轨迹,并以色块识别的方法将机器人当前的位置坐标信息和朝向信息通过通信协议UDP反馈给步骤6中给出的目标跟踪控制器,从而实现闭环控制,其中,机器人的朝向通过获取机器人上两个不同颜色的色块的中心坐标来换算得到;此外,当机器人运动到当前给定的目标点时,重复执行步骤5,给出下一个目标点的坐标,实现分段目标跟踪,最终达到路径跟踪的效果。
本发明的技术构思为:本发明针对巡回类任务,通过地图构建模块、任务描述模块、拓扑构建模块、路径寻优模块、位姿信息反馈模块和目标跟踪控制器模块各模块的设计,采用基于线性时序逻辑的最优路径规划方法规划出满足任务需求的最优路径,然后采用目标跟踪控制方法实现路径跟踪控制,达到了巡回类任务的需求。
本发明的优点是:采用了线性时序逻辑语言来描述复杂任务需求,将任务以线性时序逻辑公式的形式表达,更贴近人类自然语言,简洁方便;采用基于线性时序逻辑的路径规划方法,能够搜索出既满足线性时序逻辑公式,又符合机器人当前运行环境的最优路径;采用目标跟踪控制方法实现移动机器人的路径跟踪控制,区别于传统的控制方法,精度更高,适用范围更广,且实现方便;采用分段目标跟踪的方法最终达到路径跟踪的效果,使得机器人最终的实际路径和理想的最优路径偏差较小;采用一台全局摄像头,通过色块识别的方法同时获取机器人的位置和朝向信息,便捷且误差较小,同时能够记录并显示机器人实际的运动轨迹。本发明可以广泛的应用于诸如火灾救灾、狭小空间搬运、排障等危险的实际应用中,实现机器人替人,减少损失,降低任务风险。
附图说明
图1是本发明的系统结构框架
图2是本发明系统设计总体框架
图3是本发明闭环目标跟踪控制方法的基本框图
图4是本发明目标跟踪控制方法流程图
图5是本发明加权切换系统示例
图6是本发明可行网络拓扑示例
图7是本发明所采用的两轮差动机器人运动学特性示意图
图8(a)是本发明机器人与目标点之间距离变化曲线图
图8(b)是本发明机器人与目标点之间的角度变化曲线图
图8(c)是本发明机器人左右两轮速度变化仿真结果示意图
图9是本发明位姿信息反馈模块定位程序显示界面
图10是本发明实验室地图
图11是本发明实验案例结果示意图
具体实施方式
以下结合附图对本发明的技术方案作进一步描述。本发明实施例用来说明本发明,而不是对本发明进行限制,在本发明的精神和权利要求的保护范围内,对本发明做出的任何修改和改变,都落入本发明的保护范围。
图1为基于目标跟踪控制策略的单移动机器人最优巡回控制方法结构框图,图2为基于目标跟踪控制策略的单移动机器人最优巡回控制方法实施例的总体框架,它包括一台网络摄像机、一台图像处理服务器、一台路径规划计算机、两轮差动机器人,以及机器人运行的实验平台。
本实施例中以图5所示的加权切换系统为例。
步骤1,地图构建
将环境区域划分为5个部分Q1={q0,q1,q2,q3,q4},其中Q10=q0表示机器人的初始位置,机器人在环境中的移动对应区域的变化,表示为→。从一个区域到相邻区域的移动距离或是机器人移动的成本(权值),如图5中箭头上的数字,表示为ω1。移动机器人在特定区域所执行的任务表示为πi∈Π1,其中i∈{1,2,3,...},Π是所有任务的集合。如此构成一个转换系统模型,用字母T1表示:T1=(Q1,Q10,→,Π1,ω1);
步骤2,任务描述
采用线性时序逻辑语言来描述指定任务,以线性时序任务公式的形式表达任务需求,并将任务公式转换为任务图表。以图5所示加权切换系统为例,任务要求巡回访问{q1,q4}两点,任务描述模块2用线性时序逻辑表达式φ3将任务表示为:
φ3=(◇□q1)∧(◇□q4)
采用LTL2BA工具箱将表达式转换成对应的Büchi自动机B1输出至拓扑构建模块3。
步骤3,拓扑构建
将T1和B1作笛卡尔乘积,得到任务可行网络拓扑,用字母P1表示,即P1=T1×B1。如图6所示即为所得的任务可行网络拓扑P1。
步骤4,路径寻优
采用基于Dijkstra算法的最优路径搜索算法,在输入的任务可行网络拓扑上搜索出满足任务需求的最优路径。以图6所示的任务可行网络拓扑为例,路径寻优模块4搜索所得最优路径为:
(q0,s0)→(q1,s0)→(q2,s1)→(q4,s1)→(q3,s2)→(q1,s0)→...
其中(q1,s0)→(q2,s1)→(q4,s1)→(q3,s2)→(q1,s0)→...为巡回部分。将其映射回图5所示的加权切换系统上的最优路径为:
q0→q1→q2→q4→q3→q1→q2→...
其中,q1→q2→q4→q3→q1→q2→...为巡回部分,该路径既满足任务φ3的需求,又符合图5所示的机器人运行环境。
步骤5,任务分解
将步骤4所得最优路径对应的的坐标点集{q0,q1,q2,q4,q3,q1,q2,q4,...}存入缓存中,并结合当前任务完成情况(已访问的坐标点),按序将坐标点集中的坐标发送给目标跟踪控制器。
步骤6,目标跟踪控制
结合步骤5给出的目标点坐标(x*,y*)和实时反馈的机器人当前位置坐标(x,y),根据两轮差动机器人运动学特性,可以得到机器人到目标点的距离偏差r为:
根据全局摄像头实时采集的机器人上前后两个不同颜色的色块中心点坐标信息,换算得到坐标系X轴的正方向按顺时针旋转到机器人正面朝向所经过的角度θ,从而可以得到机器人与目标点之间的角度偏差φ为:
其中,可表示为:
根据上述获得的机器人与目标点之间的距离偏差r和角度偏差φ,采用如下控制策略:
υ=K1rcos(φ)
ω=-K1sin(φ)cos(φ)-K2φ
其中,K1和K2为控制参数,υ为机器人向前运行的速度,ω表示机器人转向时的角速度;然后,再根据两轮差动机器人的运动学特性得到移动机器人左右两轮的控制量为:
其中,υL和υR分别为目标跟踪控制模块输出的机器人左右两轮速度,d为机器人左右两轮之间的距离。υL和υR控制移动机器人朝着给定的目标点运动。
本例中根据机器人当前运行的环境取K1=8,K2=10。图8所示即为目标跟踪控制方法的仿真结果图,其中图8(a)为机器人与目标点之间距离的变化示意图,图8(b)为机器人与目标点之间角度的变化示意图,图8(c)为机器人左右两轮速度的变化示意图。
步骤7,位姿信息反馈
在机器人运行过程中,采用全局相机实时采集机器人当前运行环境的图像信息,通过图像处理记录并显示机器人的运行轨迹,并以色块识别的方法将机器人当前的位置坐标信息和朝向信息通过通信协议UDP反馈给步骤6中给出的目标跟踪控制器,实现闭环控制;其中,机器人的朝向通过获取机器人上两个不同颜色的色块的中心坐标来换算得到;此外,当机器人运动到当前给定的目标点时,重复执行步骤5,给出下一个目标点的坐标,实现分段目标跟踪,最终达到路径跟踪的效果。图9即为位姿信息反馈模块定位程序显示界面,其中定位程序通过色块识别来定位机器人当前的坐标,左边栏用来选取需要定位的色块,右上角区域为图像实时采集区域,右下角区域为所选色块坐标变化曲线记录区域。
以图10所示的实验室地图为例,阴影部分为障碍区域,贴有黄蓝色块的物体为机器人,黄色为机器人的正面,白色节点为选取的加权切换系统节点,节点之间的距离即为加权切换系统的权值,任意节点之间都是连通的。给定任务“巡回访问A、B、C、D、E五个节点”。基于目标跟踪控制策略的单移动机器人最优巡回控制方法最终获得的路径如图11所示。
实验显示基于目标跟踪控制策略的单移动机器人最优巡回控制方法能够规划出既满足任务需求,又符合环境信息的最优路径,并能够较为精确的控制机器人完成最优路径跟踪。
Claims (2)
1.基于目标跟踪控制策略的单移动机器人最优巡回控制方法,包括地图构建、任务描述、拓扑构建、路径寻优、任务分解、目标跟踪控制和位姿信息反馈7个步骤,其特征在于:首先,对输入的环境信息进行建模,构建加权切换系统模型,同时输入描述任务需求的线性时序任务公式,并进行转换,输出任务图表;其次,将加权切换系统模型和任务图表进行融合,构建任务可行网络拓扑;接着,采用基于Dijkstra算法的最优路径搜索算法在任务可行网络拓扑上搜索出满足任务需求的最优路径,并将任务可行网络拓扑上的最优路径映射回加权切换系统模型,获得环境中满足任务需求的最优路径;之后,将实际环境中对应最优路径上的离散坐标点存储在缓存中,并结合当前任务完成情况,按序读取缓存中的目标点;然后,采用目标跟踪控制策略,结合目标点坐标信息和实时反馈的机器人位置与朝向信息,根据机器人与目标点之间的距离和角度的偏差给出控制量,控制机器人完成最优路径跟踪;最后,实时采集机器人当前运行环境的图像信息,通过色块识别的方法,采用UDP通信的方式,反馈回机器人当前的位置坐标和朝向信息,具体实现步骤如下:
步骤1,地图构建
将机器人当前运行环境构建为加权切换系统模型;将移动机器人所在的运行环境划分为有限多个方块区域,每个独立的区域用字母qi∈Q表示,其中i∈{1,2,3,...},Q是区域的集合,Q0表示机器人的初始位置,机器人在环境中的移动对应区域的变化,表示为→;从一个区域到相邻区域的移动距离或是机器人移动的成本(权值),表示为ω,移动机器人在特定区域所执行的任务表示为πi∈Π,其中i∈{1,2,3,...},Π是所有任务的集合;如此构成一个转换系统模型,用字母T表示:T=(Q,Q0,→,Π,ω);
步骤2,任务描述
采用线性时序逻辑语言来描述指定任务,以线性时序任务公式的形式表达任务需求,并将任务公式转换为任务图表;线性时序逻辑语言产生的表达式基于切换系统的任务集合πi∈Π,线性时序逻辑语言的语法包括如下:线性时序逻辑语言的谓词包括(非)、∨(或)、∧(与)、□(全局)、◇(最终)、U(直到);用线性时序逻辑语言表述的任务需求用字母φ表示,φ是由切换系统模型中的子任务πi∈Π和谓词所组成的表达式:假设φ1和φ2为两个任务需求,表示不能执行φ1,表示执行φ2同时避免执行φ1,φ1∧(□φ2)表示执行φ1和φ2并最终执行φ2,(◇□φ1)∧(◇□φ2)表示循环执行φ1和φ2;采用线性时序逻辑语言表述的移动机器人巡回任务为:
(◇□O)∧(◇□q1)∧(◇□q2)∧(◇□q3)∧...
其中,O为机器人运行环境中需要全局避开的区域,qi∈Q为环境中需要巡回的节点;在获得任务表达式后,采用LTL2BA工具箱将任务表达式φ转换成对应的Büchi自动机,Büchi自动机是可判断输入的路径序列是否满足任务需求的图表,用字母B表示:B=(S,S0,∑B,δB,F),其中S是有限状态集合,是初始状态集合,∑B是输入字母表,δB是转换函数,是最终状态集合;Büchi自动机可以保证路径满足任务需求;
步骤3,拓扑构建
将加权切换系统模型和任务图表相融合构建任务可行网络拓扑;把输入的加权切换系统模型T与任务图表B作笛卡尔乘积,得到任务可行网络拓扑,用字母P表示,即P=T×B,其中T=(Q,Q0,→,Π,ω),B=(S,S0,∑B,δB,F),P=(SP,Sp0,→P,FP),SP=Q×S为有限状态集合,Sp0=Q0×S0为初始状态集合,为转换函数,FP=Q×F为最终状态集合;在任务可行网络拓扑上所包含的路径,既满足指定的任务需求,又符合机器人当前的运行环境;
步骤4,路径寻优
采用基于Dijkstra算法的最优路径搜索算法,根据线性时序逻辑任务公式中要求访问节点的出现顺序,在任务可行网络拓扑上搜索出最优路径;然后,将任务可行网络拓扑上的最优路径映射回加权切换系统模型上,获得实际环境中的最优路径;其中,搜索所得的最优路径为一个机器人运行环境中最优路径上对应的离散坐标点集;
步骤5,任务分解
将步骤4所得的最优路径存入缓存,并结合当前任务完成情况(已访问的点),按序将离散坐标点集中的坐标信息发送给目标跟踪控制器,用以控制机器人实现路径跟踪,直到遍历离散坐标点集中的所有点,以确保机器人完成完整的路径跟踪;
步骤6,目标跟踪控制
结合步骤5给出的目标点坐标(x*,y*)和实时反馈的机器人当前位置坐标(x,y),根据两轮差动机器人运动学特性,可以得到机器人到目标点的距离偏差r为:
根据全局摄像头实时采集的机器人上前后两个不同颜色的色块中心点坐标信息,换算得到坐标系X轴的正方向按顺时针旋转到机器人正面朝向所经过的角度θ,从而可以得到机器人与目标点之间的角度偏差φ为:
其中,可表示为:
根据上述获得的机器人与目标点之间的距离偏差r和角度偏差φ,采用具有如下形式的控制器,获得机器人的线速度和转动速度
υ=K1rcos(φ)
ω=-K1sin(φ)cos(φ)-K2φ
其中,K1和K2为控制参数,υ为机器人向前运行的速度,ω表示机器人转向时的角速度;然后,再根据两轮差动机器人的运动学特性得到移动机器人左右两轮的控制量为:
其中,υL和υR分别表示机器人的左右两轮速度,d为机器人左右两轮之间的距离;在控制量υL和υR的作用下,移动机器人朝着给定的目标点运行;
步骤7,位姿信息反馈
在机器人运行过程中,采用全局相机实时采集机器人当前运行环境的图像信息,通过图像处理记录并显示机器人的运行轨迹,并以色块识别的方法将机器人当前的位置坐标信息和朝向信息通过通信协议UDP反馈给步骤6中给出的目标跟踪控制器,从而实现闭环控制,其中,机器人的朝向通过获取机器人上两个不同颜色的色块的中心坐标来换算得到;此外,当机器人运动到当前给定的目标点时,重复执行步骤5,给出下一个目标点的坐标,实现分段目标跟踪,最终达到路径跟踪的效果。
2.根据权利要求1所述的基于目标跟踪控制策略的单移动机器人最优巡回控制方法,其特征在于所述的步骤6中,目标跟踪控制器
υ=K1rcos(φ)
ω=-K1sin(φ)cos(φ)-K2φ
中的控制参数K1和K2必须都大于零,以满足李雅普诺夫稳定性判据,使得在有限的时间内,机器人到目标点的距离r和机器人与目标点之间的角度偏差φ能够收敛到0,即,使得目标跟踪控制器能够控制机器人向目标点运动;而且,控制参数K1和K2取值的差值不可过大,以免K1和K2差值过大时机器人会产生很高的角速度,导致机器人蛇形前进,影响控制效果。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510167059.4A CN104834309B (zh) | 2015-04-10 | 2015-04-10 | 基于目标跟踪控制策略的单移动机器人最优巡回控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510167059.4A CN104834309B (zh) | 2015-04-10 | 2015-04-10 | 基于目标跟踪控制策略的单移动机器人最优巡回控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104834309A true CN104834309A (zh) | 2015-08-12 |
CN104834309B CN104834309B (zh) | 2018-08-21 |
Family
ID=53812253
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510167059.4A Active CN104834309B (zh) | 2015-04-10 | 2015-04-10 | 基于目标跟踪控制策略的单移动机器人最优巡回控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104834309B (zh) |
Cited By (36)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105388851A (zh) * | 2015-10-30 | 2016-03-09 | 黑龙江大学 | 运动体视觉控制系统和方法、机电运动体以及移动终端 |
CN105467997A (zh) * | 2015-12-21 | 2016-04-06 | 浙江工业大学 | 基于线性时序逻辑理论的仓储机器人路径规划方法 |
CN105759825A (zh) * | 2016-05-18 | 2016-07-13 | 刘学良 | 一种基于模糊pid的agv机器人定位控制算法 |
CN105892459A (zh) * | 2016-04-01 | 2016-08-24 | 清华大学 | 一种非时间参考的差速驱动机器人定点跟踪控制方法 |
CN106500697A (zh) * | 2016-10-13 | 2017-03-15 | 浙江工业大学 | 适用于动态环境的ltl‑a*‑a*最优路径规划方法 |
WO2017088720A1 (zh) * | 2015-11-26 | 2017-06-01 | 纳恩博(北京)科技有限公司 | 规划最优跟随路径的方法、装置及计算机存储介质 |
CN107037807A (zh) * | 2016-02-04 | 2017-08-11 | 科沃斯机器人股份有限公司 | 自移动机器人位姿校准系统和方法 |
CN107092265A (zh) * | 2017-06-22 | 2017-08-25 | 义乌文烁光电科技有限公司 | 一种适用于矩阵式仓库的分拣小车路径规划方法 |
CN107169591A (zh) * | 2017-04-21 | 2017-09-15 | 浙江工业大学 | 基于线性时序逻辑的移动端快递派送路径规划方法 |
CN107505939A (zh) * | 2017-05-13 | 2017-12-22 | 大连理工大学 | 一种移动机器人的全覆盖路径规划方法 |
WO2018058557A1 (en) * | 2016-09-30 | 2018-04-05 | Intel Corporation | Human search and identification in complex scenarios |
CN107992054A (zh) * | 2017-12-17 | 2018-05-04 | 上海物景智能科技有限公司 | 一种机器人的定位的方法及系统 |
CN108072369A (zh) * | 2016-11-16 | 2018-05-25 | 阳光暖果(北京)科技发展有限公司 | 一种可配置策略的移动机器人导航方法 |
CN108154262A (zh) * | 2017-12-19 | 2018-06-12 | 中南大学 | 一种基于形式化方法的物流运输无人车多任务规划方法 |
WO2018107505A1 (zh) * | 2016-12-17 | 2018-06-21 | 深圳前海达闼云端智能科技有限公司 | 一种对目标进行控制的方法、控制装置及控制设备 |
WO2018121794A1 (zh) * | 2016-12-30 | 2018-07-05 | 纳恩博(北京)科技有限公司 | 一种控制方法、电子设备及存储介质 |
CN108287544A (zh) * | 2018-01-16 | 2018-07-17 | 中国科学院福建物质结构研究所 | 一种智能机器人路线规划及沿原路径返回的方法及系统 |
CN108334089A (zh) * | 2018-02-08 | 2018-07-27 | 合肥工业大学 | 地图构建方法和装置、控制机器人的方法、装置及芯片 |
CN108415434A (zh) * | 2018-03-29 | 2018-08-17 | 五邑大学 | 一种机器人调度方法 |
CN108413980A (zh) * | 2018-06-07 | 2018-08-17 | 华北电力大学 | 一种减少路径分支的交通巡回路径规划方法 |
CN108520543A (zh) * | 2018-04-09 | 2018-09-11 | 网易(杭州)网络有限公司 | 一种对相对精度地图进行优化的方法、设备及存储介质 |
CN108536135A (zh) * | 2017-03-06 | 2018-09-14 | 苏州宝时得电动工具有限公司 | 路径控制方法、装置及清洁机器人 |
CN108958202A (zh) * | 2018-07-27 | 2018-12-07 | 齐齐哈尔大学 | 一种多机器人协同探索的方法 |
CN109634285A (zh) * | 2019-01-14 | 2019-04-16 | 深圳市傲基电子商务股份有限公司 | 割草机器人及其控制方法 |
CN109719727A (zh) * | 2019-01-18 | 2019-05-07 | 芜湖智久机器人有限公司 | 一种机器人通信及故障检测系统及方法 |
CN109822597A (zh) * | 2019-04-14 | 2019-05-31 | 北京中大科慧科技发展有限公司 | 一种数据中心的全自动智能巡检机器人 |
CN110286672A (zh) * | 2019-05-13 | 2019-09-27 | 深圳创动科技有限公司 | 机器人及其导航控制方法、导航控制装置以及存储介质 |
CN111026062A (zh) * | 2019-12-24 | 2020-04-17 | 中国一拖集团有限公司 | 基于组合逻辑算法的混流加工过程跟踪方法及系统 |
CN111399489A (zh) * | 2018-12-14 | 2020-07-10 | 北京京东尚科信息技术有限公司 | 用于生成信息的方法和装置 |
CN111521181A (zh) * | 2019-02-01 | 2020-08-11 | 北京京东尚科信息技术有限公司 | 一种行驶偏差的确定方法和装置 |
CN111880575A (zh) * | 2020-08-10 | 2020-11-03 | 重庆依塔大数据研究院有限公司 | 基于颜色追踪的控制方法、装置、存储介质及机器人 |
CN112530267A (zh) * | 2020-12-17 | 2021-03-19 | 河北工业大学 | 一种基于计算机视觉的机械臂智能示教方法及应用 |
CN112967336A (zh) * | 2021-01-25 | 2021-06-15 | 广东技术师范大学 | 一种基于视频目标运动跟踪的人机安全协作方法及装置 |
CN113110443A (zh) * | 2021-04-12 | 2021-07-13 | 大连理工大学 | 一种基于摄像头的机器人循迹及定位方法 |
CN113408949A (zh) * | 2021-07-15 | 2021-09-17 | 浙江大学 | 一种机器人时序任务规划方法及装置、电子设备 |
WO2023124821A1 (zh) * | 2021-12-30 | 2023-07-06 | 杭州海康机器人股份有限公司 | 用于构建移动机器人地图之数据的采集方法、装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101630413A (zh) * | 2009-08-14 | 2010-01-20 | 浙江大学 | 一种多机器人跟踪移动目标算法 |
CN101791800A (zh) * | 2010-01-21 | 2010-08-04 | 西北工业大学 | 一种双轮差动式机器人运动控制方法 |
KR20120013057A (ko) * | 2010-08-04 | 2012-02-14 | 중앙대학교 산학협력단 | 로봇 경로 제어 방법 및 장치 |
CN103278164A (zh) * | 2013-06-13 | 2013-09-04 | 北京大学深圳研究生院 | 一种复杂动态场景下机器人仿生路径规划方法及仿真平台 |
CN103383569A (zh) * | 2013-05-31 | 2013-11-06 | 浙江工业大学 | 基于线性时序逻辑的移动机器人最优巡回路径设定方法 |
-
2015
- 2015-04-10 CN CN201510167059.4A patent/CN104834309B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101630413A (zh) * | 2009-08-14 | 2010-01-20 | 浙江大学 | 一种多机器人跟踪移动目标算法 |
CN101791800A (zh) * | 2010-01-21 | 2010-08-04 | 西北工业大学 | 一种双轮差动式机器人运动控制方法 |
KR20120013057A (ko) * | 2010-08-04 | 2012-02-14 | 중앙대학교 산학협력단 | 로봇 경로 제어 방법 및 장치 |
CN103383569A (zh) * | 2013-05-31 | 2013-11-06 | 浙江工业大学 | 基于线性时序逻辑的移动机器人最优巡回路径设定方法 |
CN103278164A (zh) * | 2013-06-13 | 2013-09-04 | 北京大学深圳研究生院 | 一种复杂动态场景下机器人仿生路径规划方法及仿真平台 |
Cited By (51)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105388851A (zh) * | 2015-10-30 | 2016-03-09 | 黑龙江大学 | 运动体视觉控制系统和方法、机电运动体以及移动终端 |
CN105388851B (zh) * | 2015-10-30 | 2018-03-27 | 黑龙江大学 | 运动体视觉控制系统和方法、机电运动体以及移动终端 |
WO2017088720A1 (zh) * | 2015-11-26 | 2017-06-01 | 纳恩博(北京)科技有限公司 | 规划最优跟随路径的方法、装置及计算机存储介质 |
CN105467997B (zh) * | 2015-12-21 | 2017-12-29 | 浙江工业大学 | 基于线性时序逻辑理论的仓储机器人路径规划方法 |
CN105467997A (zh) * | 2015-12-21 | 2016-04-06 | 浙江工业大学 | 基于线性时序逻辑理论的仓储机器人路径规划方法 |
CN107037807A (zh) * | 2016-02-04 | 2017-08-11 | 科沃斯机器人股份有限公司 | 自移动机器人位姿校准系统和方法 |
CN105892459A (zh) * | 2016-04-01 | 2016-08-24 | 清华大学 | 一种非时间参考的差速驱动机器人定点跟踪控制方法 |
CN105892459B (zh) * | 2016-04-01 | 2018-07-06 | 清华大学 | 一种非时间参考的差速驱动机器人定点跟踪控制方法 |
CN105759825A (zh) * | 2016-05-18 | 2016-07-13 | 刘学良 | 一种基于模糊pid的agv机器人定位控制算法 |
US10607070B2 (en) | 2016-09-30 | 2020-03-31 | Intel Corporation | Human search and identification in complex scenarios |
WO2018058557A1 (en) * | 2016-09-30 | 2018-04-05 | Intel Corporation | Human search and identification in complex scenarios |
CN106500697A (zh) * | 2016-10-13 | 2017-03-15 | 浙江工业大学 | 适用于动态环境的ltl‑a*‑a*最优路径规划方法 |
CN108072369A (zh) * | 2016-11-16 | 2018-05-25 | 阳光暖果(北京)科技发展有限公司 | 一种可配置策略的移动机器人导航方法 |
WO2018107505A1 (zh) * | 2016-12-17 | 2018-06-21 | 深圳前海达闼云端智能科技有限公司 | 一种对目标进行控制的方法、控制装置及控制设备 |
WO2018121794A1 (zh) * | 2016-12-30 | 2018-07-05 | 纳恩博(北京)科技有限公司 | 一种控制方法、电子设备及存储介质 |
CN108536135B (zh) * | 2017-03-06 | 2023-10-27 | 苏州宝时得电动工具有限公司 | 路径控制方法、装置及清洁机器人 |
CN108536135A (zh) * | 2017-03-06 | 2018-09-14 | 苏州宝时得电动工具有限公司 | 路径控制方法、装置及清洁机器人 |
CN107169591B (zh) * | 2017-04-21 | 2020-10-27 | 浙江工业大学 | 基于线性时序逻辑的移动端快递派送路径规划方法 |
CN107169591A (zh) * | 2017-04-21 | 2017-09-15 | 浙江工业大学 | 基于线性时序逻辑的移动端快递派送路径规划方法 |
CN107505939B (zh) * | 2017-05-13 | 2019-07-12 | 大连理工大学 | 一种移动机器人的全覆盖路径规划方法 |
CN107505939A (zh) * | 2017-05-13 | 2017-12-22 | 大连理工大学 | 一种移动机器人的全覆盖路径规划方法 |
CN107092265A (zh) * | 2017-06-22 | 2017-08-25 | 义乌文烁光电科技有限公司 | 一种适用于矩阵式仓库的分拣小车路径规划方法 |
CN107992054A (zh) * | 2017-12-17 | 2018-05-04 | 上海物景智能科技有限公司 | 一种机器人的定位的方法及系统 |
CN108154262B (zh) * | 2017-12-19 | 2021-08-27 | 中南大学 | 一种基于形式化方法的物流运输无人车多任务规划方法 |
CN108154262A (zh) * | 2017-12-19 | 2018-06-12 | 中南大学 | 一种基于形式化方法的物流运输无人车多任务规划方法 |
CN108287544A (zh) * | 2018-01-16 | 2018-07-17 | 中国科学院福建物质结构研究所 | 一种智能机器人路线规划及沿原路径返回的方法及系统 |
CN108334089A (zh) * | 2018-02-08 | 2018-07-27 | 合肥工业大学 | 地图构建方法和装置、控制机器人的方法、装置及芯片 |
CN108334089B (zh) * | 2018-02-08 | 2021-05-18 | 合肥工业大学 | 地图构建方法和装置、控制机器人的方法、装置及芯片 |
CN108415434A (zh) * | 2018-03-29 | 2018-08-17 | 五邑大学 | 一种机器人调度方法 |
CN108415434B (zh) * | 2018-03-29 | 2021-05-25 | 五邑大学 | 一种机器人调度方法 |
CN108520543A (zh) * | 2018-04-09 | 2018-09-11 | 网易(杭州)网络有限公司 | 一种对相对精度地图进行优化的方法、设备及存储介质 |
CN108413980A (zh) * | 2018-06-07 | 2018-08-17 | 华北电力大学 | 一种减少路径分支的交通巡回路径规划方法 |
CN108413980B (zh) * | 2018-06-07 | 2021-06-11 | 华北电力大学 | 一种减少路径分支的交通巡回路径规划方法 |
CN108958202A (zh) * | 2018-07-27 | 2018-12-07 | 齐齐哈尔大学 | 一种多机器人协同探索的方法 |
CN108958202B (zh) * | 2018-07-27 | 2020-11-24 | 齐齐哈尔大学 | 一种多机器人协同探索的方法 |
CN111399489A (zh) * | 2018-12-14 | 2020-07-10 | 北京京东尚科信息技术有限公司 | 用于生成信息的方法和装置 |
CN111399489B (zh) * | 2018-12-14 | 2023-08-04 | 北京京东乾石科技有限公司 | 用于生成信息的方法和装置 |
CN109634285A (zh) * | 2019-01-14 | 2019-04-16 | 深圳市傲基电子商务股份有限公司 | 割草机器人及其控制方法 |
CN109719727A (zh) * | 2019-01-18 | 2019-05-07 | 芜湖智久机器人有限公司 | 一种机器人通信及故障检测系统及方法 |
CN111521181A (zh) * | 2019-02-01 | 2020-08-11 | 北京京东尚科信息技术有限公司 | 一种行驶偏差的确定方法和装置 |
CN109822597A (zh) * | 2019-04-14 | 2019-05-31 | 北京中大科慧科技发展有限公司 | 一种数据中心的全自动智能巡检机器人 |
CN110286672A (zh) * | 2019-05-13 | 2019-09-27 | 深圳创动科技有限公司 | 机器人及其导航控制方法、导航控制装置以及存储介质 |
CN111026062B (zh) * | 2019-12-24 | 2023-02-28 | 中国一拖集团有限公司 | 基于组合逻辑算法的混流加工过程跟踪方法及系统 |
CN111026062A (zh) * | 2019-12-24 | 2020-04-17 | 中国一拖集团有限公司 | 基于组合逻辑算法的混流加工过程跟踪方法及系统 |
CN111880575B (zh) * | 2020-08-10 | 2023-03-24 | 重庆依塔大数据研究院有限公司 | 基于颜色追踪的控制方法、装置、存储介质及机器人 |
CN111880575A (zh) * | 2020-08-10 | 2020-11-03 | 重庆依塔大数据研究院有限公司 | 基于颜色追踪的控制方法、装置、存储介质及机器人 |
CN112530267A (zh) * | 2020-12-17 | 2021-03-19 | 河北工业大学 | 一种基于计算机视觉的机械臂智能示教方法及应用 |
CN112967336A (zh) * | 2021-01-25 | 2021-06-15 | 广东技术师范大学 | 一种基于视频目标运动跟踪的人机安全协作方法及装置 |
CN113110443A (zh) * | 2021-04-12 | 2021-07-13 | 大连理工大学 | 一种基于摄像头的机器人循迹及定位方法 |
CN113408949A (zh) * | 2021-07-15 | 2021-09-17 | 浙江大学 | 一种机器人时序任务规划方法及装置、电子设备 |
WO2023124821A1 (zh) * | 2021-12-30 | 2023-07-06 | 杭州海康机器人股份有限公司 | 用于构建移动机器人地图之数据的采集方法、装置 |
Also Published As
Publication number | Publication date |
---|---|
CN104834309B (zh) | 2018-08-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104834309A (zh) | 基于目标跟踪控制策略的单移动机器人最优巡回控制方法 | |
Cui et al. | Pareto-optimal coordination of multiple robots with safety guarantees | |
Schilling | Universally manipulable body models—dual quaternion representations in layered and dynamic MMCs | |
CN105425791A (zh) | 一种基于视觉定位的群机器人控制系统及方法 | |
Norzam et al. | Analysis of mobile robot indoor mapping using GMapping based SLAM with different parameter | |
CN113050640B (zh) | 一种基于生成对抗网络的工业机器人路径规划方法和系统 | |
CN103324196A (zh) | 基于模糊逻辑的多机器人路径规划与协调避碰方法 | |
CN110083061A (zh) | 一种轮式移动机器人控制方法 | |
CN104834308A (zh) | 满足复杂需求的最优巡回控制方法 | |
CN103345164A (zh) | 多自主车辆决策与控制实时仿真实验系统 | |
CN113359710A (zh) | 一种基于los理论的农机路径跟踪方法 | |
Ren et al. | Integrated task sensing and whole body control for mobile manipulation with series elastic actuators | |
Shao | Robot path planning method based on genetic algorithm | |
Yong et al. | An autonomous navigation strategy based on improved hector slam with dynamic weighted a* algorithm | |
Jiang et al. | Mobile robot path planning based on dynamic movement primitives | |
Takahashi et al. | Walk control of segmented multi-legged robot based on integrative control of legs and 2-DoF active intersegment joints | |
Básaca-Preciado et al. | Intelligent transportation scheme for autonomous vehicle in smart campus | |
Chow et al. | Learning human navigational skill for smart wheelchair in a static cluttered route | |
Ma et al. | Path planning and task assignment of the multi-AUVs system based on the hybrid bio-inspired SOM algorithm with neural wave structure | |
Vasseur et al. | Navigation of car-like mobile robots in obstructed environments using convex polygonal cells | |
Hu et al. | Navigation and guidance of an intelligent mobile robot | |
Jeong et al. | Virtual joint method for kinematic modeling of wheeled mobile manipulators | |
Lin et al. | Simulation of Robot Automatic Control Model Based on Artificial Intelligence Algorithm | |
Fan et al. | On evolutionary genetic algorithm in path planning for a USV collision avoidance | |
Rosero et al. | CNN-Planner: A neural path planner based on sensor fusion in the bird's eye view representation space for mapless autonomous driving |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |