CN103994768B - 动态时变环境下寻求全局时间最优路径的方法及系统 - Google Patents
动态时变环境下寻求全局时间最优路径的方法及系统 Download PDFInfo
- Publication number
- CN103994768B CN103994768B CN201410222902.XA CN201410222902A CN103994768B CN 103994768 B CN103994768 B CN 103994768B CN 201410222902 A CN201410222902 A CN 201410222902A CN 103994768 B CN103994768 B CN 103994768B
- Authority
- CN
- China
- Prior art keywords
- time
- time interval
- environment
- road
- interval
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种动态时变环境下寻求全局时间最优路径的方法及系统;其中方法包括:对环境状态信息的提取;对环境的空间建模;依据环境状态信息对环境进行时间划分,即将时间轴划分为若干个时间间隔,并用时间消耗来表示各时间间隔的环境状态;运用改进的A*算法对环境模型进行搜索以得到全局时间最优路径;通过引入权重达到多尺度路径规划目的。本发明对于室内机器人避障、室外道路交通复杂时变环境的路径寻优都能达到良好的目的,并且能够根据用户的不同需求,在时间代价和距离代价之间进行权衡以制定最佳路线并准确计算行程花费时间。
Description
技术领域
本发明涉及动态环境中的碰撞避免及路径寻优算法及系统,尤其涉及一种针对复杂动态时变环境下寻求全局时间最优路径的方法及系统。
背景技术
随着社会的进步、科技的发展,如今计算机的应用领域可谓愈发广泛,其中机器人研究为目前计算机领域中最热门的课题之一。路径规划技术是机器人研究领域中的一个重要分支,所谓路径规划问题一般理解为在具有障碍物的环境中,按照一定的评价标准(如工作代价最小、行走路线最短、行走时间最短等),寻找一条从起始状态到目标状态的无碰撞路径。其应用领域非常广泛,如:机器人寻路蔽障的路径规划、飞行器航迹规划、巡航导弹路径规划、旅行商问题以及其衍生的各种车辆路径规划、基于道路网的路径规划、电子地图GPS导航路径搜索与规划、路由问题等,因此具有重要的实用价值和广阔的发展前景。
然而,由于路径规划应用的场合不尽相同,尤其对于求解动态复杂时变环境中的全局最优路径规划问题,对路径寻优算法提出了更高的要求。其中,在交通道路环境中的车辆导航问题更是该领域研究的难点与热点。如何让机器人能够充分考虑动态障碍物的运动轨迹而制定出可行的行走方案,以及如何针对时变的道路交通状态而制定一条从起始点到终点时间花费最优路径,并且可以通过权衡时间与空间的代价,为客户搜寻一条全局最优路径已经成为衡量导航系统优劣的重要标准。
发明内容
本发明的目的在于解决针对复杂动态时变的环境下寻求全局时间最优路径的需求问题,充分考虑移动障碍物以及环境的时变性,提供一种针对复杂动态时变的环境下寻求全局时间最优路径的方法,基于本发明,可以实现室内动态环境中机器人避障、道路交通复杂时变环境中搜寻时间花费最优路径,并且能够根据用户的不同需求,对时间以及空间消耗进行权衡以制定最佳行走路线并准确估计花费时间。
为解决上述技术问题,本发明提供的技术方案为:一种针对动态时变环境下寻求全局时间最优路径的方法,包括如下步骤:
数据获取步骤:通过交通监控平台系统获得历史及实时的路况信息;
空间数据处理步骤:依据道路或环境空间特征,进行空间划分,划分成若干个子区域;一般情况,对于室内环境,利用栅格法对环境进行空间划分,栅格的大小可依据机器人的体积、灵敏度及环境特征进行选取,对于室外交通复杂环境,通常利用邻接矩阵表示,其中一条无岔路的路段被抽象为一个子区域,其道路邻接信息用邻接矩阵表示;
时间数据处理步骤:依据环境变化状态,对每一个划分好的子区域再进行时间上的划分,将划分好的每一个时间段称之为时间间隔,并为每一个划分好的时间间隔增加时间消耗变量;
时间间隔的划分依据为:在室内场景中,对于一个空间上划分好的栅格,依据其时间段内是否有障碍物通过将其划分为若干个时间间隔,并且对无障碍物通过的时间间隔给予其1个时间单位的时间消耗,对于有障碍物通过的时间间隔给予其无穷大的时间消耗,代表其无法行走;对于室外交通环境,对时间的划分则依据其道路交通状态的变化,将道路状态趋于稳定的时间段划分为一个时间间隔,并且赋予其一个在该道路状态下车辆行驶通过该路段的平均时间消耗;
运用A*算法拓展搜索步骤:引入到达时刻变量,其求解由起始时刻与时间间隔中时间消耗的累加得到;拓展的可达性根据到达时刻是否可在子区域的时间间隔内确定,搜索过程中通过建立OPEN列表,每次将其中具有最小评价函数的时间间隔取出进行拓展以减小搜索空间;
改变权值步骤:通过权衡时间及空间消耗,制定出相应权值下的最优路径,从而满足用户对道路所花费时间及路程的不同需求。
所述运用A*算法拓展搜索步骤中,拓展对象为时间间隔,而非子区域,并且为每个时间间隔引入到达时刻变量,其到达时刻及评价函数由以下公式确定:
当拓展时间间隔未被访问,且到达时刻可在拓展时间间隔的时间间隔之内时,其到达时刻为:
T(s′)=T(s)+C(s′)或
T(s′)=max(T(s)+C(s′),ts(s′))
当拓展时间间隔已被访问过,且新计算出的到达时刻可在拓展时间间隔的时间间隔之内时,其到达时刻为:
T(s′)=T(s)+C(s′)或
T(s′)=min(max(T(s)+C(s′),ts(s′)),Tpre(s′))
其中s′代表拓展的时间间隔,T(s′)代表该时间间隔的到达时刻,T(s)表示其前驱时间间隔的到达时刻,C(s′)表示该时间间隔的时间消耗,ts(s′)表示时间间隔s′的起始时刻,Tpre(s′)表示之前算出s′的到达时刻;
其中评价函数由以下公式确定:
F(s)=w′H(s)+T(s)
其中F(s)表示时间间隔s的评价函数,w为权值影响因子,其值大于等于1,H(s)为启发式函数,为使得改变权值后的求解仍为当前条件下最优解,其值由Dijkstra算法求得。
所述数据获取步骤中,对于室内环境,其数据由搭载于机器人上的摄像头获取并预测;对于室外交通环境,其数据通过谷歌及百度地图获取。
本发明还提供了基于一种针对动态时变环境下寻求全局时间最优路径的方法的系统,包括:
数据获取模块:通过交通监控平台系统获得历史及实时的路况信息;
空间数据处理模块:依据道路或环境空间特征,进行空间划分,划分成若干个子区域;一般情况,对于室内环境,利用栅格法对环境进行空间划分,栅格的大小可依据机器人的体积、灵敏度及环境特征进行选取,对于室外交通复杂环境,通常利用邻接矩阵表示,其中一条无岔路的路段被抽象为一个子区域,其道路邻接信息用邻接矩阵表示;
时间数据处理模块:依据环境变化状态,对每一个划分好的子区域再进行时间上的划分,将划分好的每一个时间段称之为时间间隔,并为每一个划分好的时间间隔增加时间消耗变量;
时间间隔的划分依据为:在室内场景中,对于一个空间上划分好的栅格,依据其时间段内是否有障碍物通过将其划分为若干个时间间隔,并且对无障碍物通过的时间间隔给予其1个时间单位的时间消耗,对于有障碍物通过的时间间隔给予其无穷大的时间消耗,代表其无法行走;对于室外交通环境,对时间的划分则依据其道路交通状态的变化,将道路状态趋于稳定的时间段划分为一个时间间隔,并且赋予其一个在该道路状态下车辆行驶通过该路段的平均时间消耗;
运用A*算法拓展搜索模块:引入到达时刻变量,其求解由起始时刻与时间间隔中时间消耗的累加得到;拓展的可达性根据到达时刻是否可在子区域的时间间隔内确定,搜索过程中通过建立OPEN列表,每次将其中具有最小评价函数的时间间隔取出进行拓展以减小搜索空间;
改变权值模块:通过权衡时间及空间消耗,制定出相应权值下的最优路径,从而满足用户对道路所花费时间及路程的不同需求。
所述运用A*算法拓展搜索模块中,拓展对象为时间间隔,而非子区域,并且为每个时间间隔引入到达时刻变量,其到达时刻及评价函数由以下公式确定:
当拓展时间间隔未被访问,且到达时刻可在拓展时间间隔的时间间隔之内时,其到达时刻为:
T(s′)=T(s)+C(s′)或
T(s′)=max(T(s)+C(s′),ts(s′))
当拓展时间间隔已被访问过,且新计算出的到达时刻可在拓展时间间隔的时间间隔之内时,其到达时刻为:
T(s′)=T(s)+C(s′)或
T(s′)=min(max(T(s)+C(s′),ts(s′)),Tpre(s′))
其中s′代表拓展的时间间隔,T(s′)代表该时间间隔的到达时刻,T(s)表示其前驱时间间隔的到达时刻,C(s′)表示该时间间隔的时间消耗,ts(s′)表示时间间隔s′的起始时刻,Tpre(s′)表示之前算出s′的到达时刻;
其中评价函数由以下公式确定:
F(s)=w′H(s)+T(s)
其中F(s)表示时间间隔s的评价函数,w为权值影响因子,其值大于等于1,H(s)为启发式函数,为使得改变权值后的求解仍为当前条件下最优解,其值由Dijkstra算法求得。
所述数据获取模块中,对于室内环境,其数据由搭载于机器人上的摄像头获取并预测;对于室外交通环境,其数据通过谷歌及百度地图获取。
相对于现有的导航技术而言,本发明通过对环境进行空间以及时间上的处理划分,引入时间间隔以及时间消耗概念,运用A*拓展思想进行时间消耗最优路径的搜索,解决了动态时变环境中路径规划的很多问题:一般的处理动态环境中路径规划问题都是通过间歇性地运用静态搜索算法处理变化后的环境以不断纠正规划路径直到到达终点,其搜索结果往往是次优的并且有时并不能解决极端环境中机器人充分考虑动态障碍物的行走轨迹从而规划出蔽障路径的问题;动态时变环境中寻求全局时间花费最少路径;交通导航中通过对路况的分析寻求全局时间花费最少路径;根据用户的需求,权衡时间与空间的消耗从而指定出符合用户需求的全局最优导航路径。
本发明能够有效解决极端环境中机器人蔽障问题、求解动态环境中全局时间花费最优问题、交通导航中根据客户需求权衡时间与空间消耗以制定全局最优路径问题。相比于其他算法,其算法执行速度、求解结果上都有其优越性,能够实现多尺度导航需求。
附图说明
图1为本发明针对动态时变环境下寻求全局时间最优路径方法的步骤流程图;
图2为谷歌地图截图;
图3为室内环境栅格法建模图;
图4为室外交通环境栅格法建模图;
图5为图3环境下A、B、C三栅格时间间隔及时间消耗建模图;
图6为道路交通时变环境中依据环境信息对各节点进行时间划分示意图;
图7为本发明所涉及伪代码;
图8为拓展规则示例示意图;
图9为模拟图3环境下运用此发明进行机器人蔽障模拟示意图;
图10为图4环境下运用本发明进行路径规划示意图;
图11为本发明引入权值影响因子进行路径规划示意图;
表1为图4室外交通环境下时变道路区域时间消耗变化表;
表2为图4所述动态时变环境中本发明与A*算法时间消耗对比表;
表3为图4所述动态时变环境中改变权值后搜索路径其总时间及路程消耗表。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
参照图1,图1为本发明针对动态时变环境下寻求全局时间最优路径的方法的步骤流程图,包括如下步骤:首先数据获取步骤:通过交通监控平台系统获得历史及实时的路况信息,这里需要说明的是,此发明需要在能够预知未来时间段内的环境信息的前提下实现,而预测未来时间段内的道路交通信息功能在现有的地图系统中均有提供,如谷歌、百度地图,针对室内场景亦能通过装载于机器人上的传感器预测障碍物的运动轨迹;
空间数据处理步骤:依据道路或环境空间特征,对其进行空间划分,以划分成若干个子区域(state),一般情况,对于室内环境,利用栅格法对环境进行空间划分,栅格的大小依据机器人的体积、灵敏度及环境特征选取,对于室外复杂交通环境,可将一条无岔路的路段抽象为一个子区域(state),其邻接道路信息用邻接矩阵表示,本步骤旨在对环境进行空间划分并记录其邻接关系;
时间数据处理步骤:依据环境变化状态,对每一个划分好的子空区域再进行时间上的划分,将划分好的每一个时间段称为时间间隔,并为每一个划分好的时间间隔增加时间消耗变量。划分依据为:在室内场景中,对于一个空间上划分好的栅格,依据其时间段内是否有障碍物通过将其划分为若干个时间间隔,并且对无障碍物通过的时间间隔给予其1个时间单位的时间消耗(或者一个准确的机器人通过一个state的时间),对于有障碍物通过的时间间隔给予其无穷大的时间消耗(代表其无法行走)。对于室外交通环境,对时间划分依据其道路拥堵状态,将道路状态趋于稳定的时间段划分为一个时间间隔,并且赋予其在该道路状态下行驶该路段的时间消耗变量;
运用A*算法进行拓展搜索步骤:引入到达时刻变量,其求解由起始时刻与各时间间隔中时间消耗的累加得到。这里拓展的可达性根据到达时刻是否可在该子区域(state)的时间间隔内确定,搜索过程中通过建立OPEN列表,每次将其中具有最小评价函数的时间间隔取出进行拓展以减小搜索空间;
改变权值:通过权衡时间及空间消耗,制定出相应权值下的最优路径,从而满足用户对道路所花费时间及路程的不同需求。
两实施例将分别对动态室内环境中机器人蔽障问题以及复杂时变的道路交通环境中路径寻优问题予以解决,相对于其他算法,该发明能够更为准确地实现机器人蔽障功能;准确计算动态时变环境中全局时间消耗最优路径;且能够根据用户的不同需求权衡时间及空间消耗制定出更为合理的行车路线。
下面结合附图和具体实施方式对本发明作进一步说明。
步骤1:数据获取步骤
本发明得以实现的前提是动态环境是可以预测的,即未来一段时间内的环境状态需要预先预测得知。针对于室内动态环境中机器人蔽障问题,其障碍物的运动轨迹可由装载于机器人中的传感器摄像头获得,并且根据当前运动速度与方向预测其接下来的行走路线。相对于室外交通环境,其实时道路交通状态以及预测未来时刻道路交通状态可由百度、谷歌地图等获得,如图2所示。
步骤2:空间划分步骤
为了能够简化搜索空间,本发明首先对环境进行空间划分,对于室内环境,发明可根据环境特征、机器人行走灵敏度及其体积,运用栅格法对环境进行划分,如图3所示,此环境为一十字交叉走廊,其中动态障碍物用黑色实心圆表示,其运动方向用箭头标出,运动速度规定为每个时间单位移动一个栅格。根据此环境特征,将其按照如图3所示的栅格将其进行空间划分。对于室外交通环境,这里需要说明的是,由于无论是栅格法还是邻接矩阵法,其目的都是为了简化搜索空间,并不影响发明的执行阶段,所以为了使发明处理动态环境中寻求全局时间最优路径的效果更为直观,我们仍用栅格法来模拟道路交通环境,如图4所示。图中,黑色正方形代表障碍物,黑色方框代表静态路径,即时间消耗不随时间的改变而改变,此例中时间消耗设置为1个时间单位,灰色正方形区域为动态时变环境,其时间消耗变化规律为每隔10个时间单位变化一次,其变化规律如表1所示。
步骤3:时间划分步骤
该步骤通过对环境信息的提取,进一步将时间信息以及环境状态信息增加至模型中,为步骤一所划分出来的栅格进行时间划分,并为每一个时间间隔增加时间消耗特征。以下是方法的具体实现:
1.对于室内动态环境,环境本身往往不是很复杂,每一个栅格只有两种状态:可行与不可行,可行就是无障碍物占用该区域,不可行就是有障碍物占用该区域,由于有动态障碍物在环境中运行,对于室内同一位置,发明依据该位置(栅格)是否有障碍物将其进行时间划分,并为每一个时间间隔增加时间消耗变量,此变量用来描述通过该栅格所需要的时间,对于可行状态,其通过时间为1,即时间消耗为1;对于不可行状态,其无法通过,时间消耗设置为无穷大。如图5所示,对应分析图2中的A、B、C三个栅格,以C为例,在时间段0到1内,无物障碍物通过C栅格,将[0,1]划分为一个时间间隔,并且赋予其1的时间消耗,在时间段2内,向左运动的障碍物将通过该栅格,之后离开,故将2时间段划分为一个时间间隔[2,2],并赋予无穷大的权值,在时间段3内该区域无障碍物占用,且下个时间段向上运动的障碍物将通过该处,故将其划分为一个时间间隔[3,3],并同样赋予1的时间消耗,在时间段4内向上运动的障碍物通过该区域,且之后该区域再无障碍物通过,将时间段4划分为一个时间间隔[4,4],并且赋值无穷大为其时间消耗,之后的时间段[5,+∞]被划分为一个时间间隔,其时间消耗设置为1,如图5所示。
2.对于室外交通场景,其划分依据类似,对于同一道路,车流量趋于稳定的时间段将划分为一个时间间隔,并赋予一个车辆平均通过时间为其时间消耗,这里需要注意的是,在此种复杂时变的交通环境下,时间消耗不仅限于1与正无穷,其时间消耗为该环境状态下车辆通过该路段的平局时间消耗,如对于同一路段,在早8点高峰期,通过该路段的平均时间消耗将会是20分钟,而在午夜时分,通过该路段的平均时间消耗则为2分钟,其更一般的建模表示如图6所示。
步骤4:运用A*算法对划分好的时间间隔进行拓展搜索
该步骤为此发明的核心步骤,但也是最为灵活的步骤,此发明以时间间隔及时间消耗的建立为基础,在其上可运用不同的拓展搜索规则进行最优搜索,这里主要介绍实验中所用搜索规则,但并非仅限于此。与传统的A*算法不同,本发明旨在搜索时间消耗最优路径而非路程最优,故此发明以步骤2中计算出的时间间隔为拓展对象进行搜索而非栅格。并且两空间相邻的时间间隔的可达性判断要依据到达时刻是否在其拓展的时间间隔内而定,其具体实施如图7伪代码所表述,为了进一步说明问题,此处通过图8所述情况解释相应代码及可达性判断(注意此处的A、B、C与图2及图4中A、B、C无任何关系),其中s代表当前时间间隔,ts(s)表示此时间间隔S的起始时刻,te(s)表示s的终止时刻,C(s)表示此时间间隔的时间消耗,T(s)代表当前时间间隔s的到达时刻,s′代表其邻接时间间隔,H(s)为启发式函数,用来估计从当前节点到目标点的距离,由于本算法需要在增大权值的情况下依然能够实现最优解,故H(s)由Dijkstra算法得到,G(s)为从起始位置到当前节点的实际时间消耗,w为权值影响因子,F(s)为评价函数。
图8中,发明假设当前待拓展的时间间隔为节点B的时间间隔sB2,其相邻节点的时间间隔s′为sA1,sA2,sA3,sC1,sC2和sC3。当这些相邻节点的时间间隔都未被访问过时:由于当前节点sB2与sC3及sA1无交集,并且到达时刻T(s′)在sC3及sA1之外,所以sB2与sC3及sA1不可达。如图7伪代码5至8行所述;尽管sB2和sA3之间有交集,但是sA3的到达时刻由公式1算出为11,不在此时间间隔之内,亦判定不可达,如图7中伪代码9行所述。
T(s′)=T(s)+C(s′)公式1
考虑计算sC2的到达时刻,T(s′)的计算则通过公式2,其到达时刻为9而不是8,如伪代码11至12行所述。
T(s′)=max(T(s)+C(s′),ts(s′))公式2
最后一种情况为求sC1和sA2的到达时刻,通过公式2可得出其到达时刻均为8,如伪代码13行所述。
至此,通过算法我们得出sC2,sC1和sA2可由sB2拓展,并求出各个拓展时间间隔的到达时刻T(s′),之后将这三个时间间隔放入OPEN表中,并赋予其相应的F(s′),及记录其前驱节点。其中F(s′)由公式3得出,如伪代码14行所述。
F(s)=w′H(s)+T(s)公式3
考虑另一种情况,即其邻接时间间隔s′已经被访问过,此种情况下算法的处理步骤依然与为被访问过时相似,只不过对于之前被访问过的时间间隔,当新求出的到达时刻T(s′)更小时,将其更新为这个更小的到达时刻,如公式4所述,并且更新其前驱节点,对应于伪代码的26,29,30行。
T(s′)=min(max(T(s)+C(s′),ts(s′)),Tpre(s′))公式4
公式3中w为权值影响因子,其取值为大于等于1的自然数,当w为1时,本发明所得结果即为全局时间最优路径,随着权值w的增大,发明更倾向于计算距离最短路径,使得求解路径用时相对增加但是路程相对减少,从而实现用户不同需求的导航目的。
实验结果如图9至11所示。其中图9所示为模拟图3环境下的机器人室内蔽障路径规划,图9a为初始状态,黑色圆点表示机器人当前位置,黑色五角星代表终点,黑色圆圈代表移动障碍物;图9b为机器人向上运动至(7,8)点,并且等待向左运动障碍物通过;图9c为机器人向下运动经过十字交叉点后向右移动以避免与向上运动障碍物发生碰撞;图9d为机器人再次移动至交叉点,而后径直向下直至到达终点;机器人起始位于(7,7)坐标位置,终点位于(7,2)五角星所示位置。图10为动态时变道路环境中依据不同的起始路径规划时刻所规划的不同路径,随着时间的推移,本发明所规划出的路径分别为1、2、3,而运用A*算法搜索到的路程最短路径均为1,且其实际时间消耗将大于本发明所规划路径的实际时间消耗,此实施例也进一步表明,本发明可针对不同的规划起始时刻制定出动态时变环境中全局时间消耗最优路径,运用于实际中效果便是:对于同一起始位置及终点,早8点高峰期制定出的路径驾驶方案与午夜时分制定出的驾驶方案会有所不同,但都是当前道路状态下的时间消耗最少路径,此发明与A*算法制定出路径的总时间消耗对比如表2所示。图11为引入权值后依据不同的需求所规划之路径,随着权值的增大,评价函数F(s)中距离因素所占的比重增大,也就是更注重搜索到一条距离消耗相对较少的路径,但相应的以牺牲更小的时间消耗为代价。权值的引入可以更好地权衡路径的时间及空间消耗,根据不同用户的需求,制定出其满意的驾驶方案,其路径距离消耗及相应时间消耗由表3呈现。
以上对本发明所提供的一种基于动态时变环境下寻求全局时间最优路径的方法进行详细分析,本文中应用了具体实施例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。
Claims (6)
1.一种针对动态时变环境下寻求全局时间最优路径的方法,其特征在于,包括如下步骤:
数据获取步骤:通过交通监控平台系统获得历史及实时的路况信息;
空间数据处理步骤:依据道路或环境空间特征,进行空间划分,划分成若干个子区域(state);一般情况,对于室内环境,利用栅格法对环境进行空间划分,栅格的大小可依据机器人的体积、灵敏度及环境特征进行选取,对于室外交通复杂环境,通常利用邻接矩阵表示,其中一条无岔路的路段被抽象为一个子区域(state),其道路邻接信息用邻接矩阵表示;
时间数据处理步骤:依据环境变化状态,对每一个划分好的子区域(state)再进行时间上的划分,将划分好的每一个时间段称之为时间间隔,并为每一个划分好的时间间隔增加时间消耗变量;
时间间隔的划分依据为:在室内场景中,对于一个空间上划分好的栅格,依据其时间段内是否有障碍物通过将其划分为若干个时间间隔,并且对无障碍物通过的时间间隔给予其1个时间单位的时间消耗,对于有障碍物通过的时间间隔给予其无穷大的时间消耗,代表其无法行走;对于室外交通环境,对时间的划分则依据其道路交通状态的变化,将道路状态趋于稳定的时间段划分为一个时间间隔,并且赋予其一个在该道路状态下车辆行驶通过该路段的平均时间消耗;
运用A*算法拓展搜索步骤:引入到达时刻变量,其求解由起始时刻与时间间隔中时间消耗的累加得到;拓展的可达性根据到达时刻是否可在子区域(state)的时间间隔内确定,搜索 过程中通过建立OPEN列表,每次将其中具有最小评价函数的时间间隔取出进行拓展以减小搜索空间;
改变权值步骤:通过权衡时间及空间消耗,制定出相应权值下的最优路径,从而满足用户对道路所花费时间及路程的不同需求。
2.根据权利要求1所述的一种针对动态时变环境下寻求全局时间最优路径的方法,其特征在于,所述运用A*算法拓展搜索步骤中,拓展对象为时间间隔,而非子区域(state),并且为每个时间间隔引入到达时刻变量,其到达时刻及评价函数由以下公式确定:
当拓展时间间隔未被访问,且到达时刻可在拓展时间间隔的时间间隔之内时,其到达时刻为:
T(s')=T(s)+C(s')或
T(s')=max(T(s)+C(s'),ts(s'))
当拓展时间间隔已被访问过,且新计算出的到达时刻可在拓展时间间隔的时间间隔之内时,其到达时刻为:
T(s')=T(s)+C(s')或
T(s')=min(max(T(s)+C(s'),ts(s')),Tpre(s'))
其中s'代表拓展的时间间隔,T(s')代表该时间间隔的到达时刻,T(s)表示其前驱时间间隔的到达时刻,C(s')表示该时间间隔的时间消耗,ts(s')表示时间间隔s'的起始时刻,Tpre(s')表示之前算出s'的到达时刻;
其中评价函数由以下公式确定:
F(s)=w×H(s)+T(s)
其中F(s)表示时间间隔s的评价函数,w为权值影响因子,其值大于等于1,H(s)为启发式函数,为使得改变权值后的求解仍为当前条件下最优解,其值由Dijkstra算法求得;
3.根据权利要求1所述的一种针对动态时变环境下寻求全局时间最优路径的方法,其特征在于,所述数据获取步骤中,对于室内环境,其数据由搭载于机器人上的摄像头获取并预测;对于室外交通环境,其数据通过谷歌及百度地图获取。
4.一种针对动态时变环境下寻求全局时间最优路径的系统,其特征在于,包括:
数据获取模块:通过交通监控平台系统获得历史及实时的路况信息;
空间数据处理模块:依据道路或环境空间特征,进行空间划分,划分成若干个子区域(state);一般情况,对于室内环境,利用栅格法对环境进行空间划分,栅格的大小可依据机器人的体积、灵敏度及环境特征进行选取,对于室外交通复杂环境,通常利用邻接矩阵表示,其中一条无岔路的路段被抽象为一个子区域(state),其道路邻接信息用邻接矩阵表示;
时间数据处理模块:依据环境变化状态,对每一个划分好的子区域(state)再进行时间上的划分,将划分好的每一个时间段称之为时间间隔,并为每一个划分好的时间间隔增加时间消耗变量;
时间间隔的划分依据为:在室内场景中,对于一个空间上划分好的栅格,依据其时间段内是否有障碍物通过将其划分为若干个时间间隔,并且对无障碍物通过的时间间隔给予其1个时间单位的时间消耗,对于有障碍物通过的时间间隔给予其无 穷大的时间消耗,代表其无法行走;对于室外交通环境,对时间的划分则依据其道路交通状态的变化,将道路状态趋于稳定的时间段划分为一个时间间隔,并且赋予其一个在该道路状态下车辆行驶通过该路段的平均时间消耗;
运用A*算法拓展搜索模块:引入到达时刻变量,其求解由起始时刻与时间间隔中时间消耗的累加得到;拓展的可达性根据到达时刻是否可在子区域(state)的时间间隔内确定,搜索过程中通过建立OPEN列表,每次将其中具有最小评价函数的时间间隔取出进行拓展以减小搜索空间;
改变权值模块:通过权衡时间及空间消耗,制定出相应权值下的最优路径,从而满足用户对道路所花费时间及路程的不同需求。
5.根据权利要求4所述的一种针对动态时变环境下寻求全局时间最优路径的系统,其特征在于,所述运用A*算法拓展搜索模块中,拓展对象为时间间隔,而非子区域(state),并且为每个时间间隔引入到达时刻变量,其到达时刻及评价函数由以下公式确定:
当拓展时间间隔未被访问,且到达时刻可在拓展时间间隔的时间间隔之内时,其到达时刻为:
T(s')=T(s)+C(s')或
T(s')=max(T(s)+C(s'),ts(s'))
当拓展时间间隔已被访问过,且新计算出的到达时刻可在拓展时间间隔的时间间隔之内时,其到达时刻为:
T(s')=T(s)+C(s')或
T(s')=min(max(T(s)+C(s'),ts(s')),Tpre(s'))
其中s'代表拓展的时间间隔,T(s')代表该时间间隔的到达时刻,T(s)表示其前驱时间间隔的到达时刻,C(s')表示该时间间隔的时间消耗,ts(s')表示时间间隔s'的起始时刻,Tpre(s')表示之前算出s'的到达时刻;
其中评价函数由以下公式确定:
F(s)=w×H(s)+T(s)
其中F(s)表示时间间隔s的评价函数,w为权值影响因子,其值大于等于1,H(s)为启发式函数,为使得改变权值后的求解仍为当前条件下最优解,其值由Dijkstra算法求得;
6.根据权利要求4所述的一种针对动态时变环境下寻求全局时间最优路径的系统,其特征在于,所述数据获取模块中,对于室内环境,其数据由搭载于机器人上的摄像头获取并预测;对于室外交通环境,其数据通过谷歌及百度地图获取。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410222902.XA CN103994768B (zh) | 2014-05-23 | 2014-05-23 | 动态时变环境下寻求全局时间最优路径的方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410222902.XA CN103994768B (zh) | 2014-05-23 | 2014-05-23 | 动态时变环境下寻求全局时间最优路径的方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103994768A CN103994768A (zh) | 2014-08-20 |
CN103994768B true CN103994768B (zh) | 2017-01-25 |
Family
ID=51309000
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410222902.XA Active CN103994768B (zh) | 2014-05-23 | 2014-05-23 | 动态时变环境下寻求全局时间最优路径的方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103994768B (zh) |
Families Citing this family (36)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10175054B2 (en) * | 2015-01-11 | 2019-01-08 | Microsoft Technology Licensing, Llc | Predicting and utilizing variability of travel times in mapping services |
CN104951918A (zh) * | 2015-06-11 | 2015-09-30 | 上海德马物流技术有限公司 | 一种时间窗路径规划方法 |
CN105116902A (zh) * | 2015-09-09 | 2015-12-02 | 北京进化者机器人科技有限公司 | 一种移动机器人避障导航的方法和系统 |
CN106933223B (zh) * | 2015-12-30 | 2020-06-26 | 深圳市朗驰欣创科技股份有限公司 | 一种机器人自主导航方法及系统 |
CN106931970A (zh) * | 2015-12-30 | 2017-07-07 | 北京雷动云合智能技术有限公司 | 一种动态环境中机器人安全自主规划导航方法 |
CN105571604B (zh) * | 2016-01-14 | 2018-08-14 | 北京师范大学 | 动态路网环境下的协同进化路径优化方法 |
CN105867427B (zh) * | 2016-04-18 | 2018-06-26 | 苏州大学 | 一种面向动态环境的机器人寻径在线控制方法 |
CN107401803A (zh) * | 2016-05-19 | 2017-11-28 | 科沃斯机器人股份有限公司 | 一种组合机器人的控制方法 |
CN106289233B (zh) * | 2016-07-25 | 2019-04-19 | 中国船舶重工集团公司第七0九研究所 | 多形态障碍的无人机路径规划方法及系统 |
CN106403925B (zh) * | 2016-08-31 | 2019-10-29 | 河南理工大学 | 面向室内与地下空间导航的空间网络构造及路径规划方法 |
CN106500697B (zh) * | 2016-10-13 | 2019-05-28 | 浙江工业大学 | 适用于动态环境的ltl-a*-a*最优路径规划方法 |
CN106767838A (zh) * | 2017-03-17 | 2017-05-31 | 上海钛米机器人科技有限公司 | 一种基于虚拟路网的服务机器人导航方法及系统 |
CN107449426B (zh) * | 2017-07-14 | 2020-05-05 | 厦门市礼小签电子科技有限公司 | 导航逻辑方法及其室内ar导航系统 |
CN107345815A (zh) * | 2017-07-24 | 2017-11-14 | 东北大学 | 一种基于改进a*算法的家庭服务机器人路径规划方法 |
CN107644076B (zh) * | 2017-09-18 | 2021-11-12 | 首都师范大学 | 路径更新方法及装置 |
CN109709945B (zh) * | 2017-10-26 | 2022-04-15 | 深圳市优必选科技有限公司 | 一种基于障碍物分类的路径规划方法、装置及机器人 |
CN108241370B (zh) * | 2017-12-20 | 2021-06-22 | 北京理工华汇智能科技有限公司 | 通过栅格地图获取避障路径的方法及装置 |
CN107990903B (zh) * | 2017-12-29 | 2021-01-05 | 东南大学 | 一种基于改进a*算法的室内agv路径规划方法 |
CN108413980B (zh) * | 2018-06-07 | 2021-06-11 | 华北电力大学 | 一种减少路径分支的交通巡回路径规划方法 |
CN108803660B (zh) * | 2018-06-22 | 2021-06-18 | 苏州得尔达国际物流有限公司 | 货运无人机群路径规划方法 |
CN109828236A (zh) * | 2019-02-14 | 2019-05-31 | 中南大学 | 一种含空区复杂结构中的微震/声发射源定位方法 |
CN110009906B (zh) * | 2019-03-25 | 2021-07-27 | 上海交通大学 | 基于交通预测的动态路径规划方法 |
CN110297492B (zh) * | 2019-07-08 | 2020-09-18 | 北京航空航天大学 | 一种多车辆网络在时变环境下的协调跟踪控制系统及方法 |
CN110889364A (zh) * | 2019-11-21 | 2020-03-17 | 大连理工大学 | 一种利用红外传感器和可见光传感器构建栅格地图的方法 |
CN110948488B (zh) * | 2019-11-26 | 2023-04-11 | 江苏集萃智能制造技术研究所有限公司 | 一种基于时间最优的机器人自适应轨迹规划算法 |
CN111735470B (zh) * | 2020-07-29 | 2021-03-02 | 上海国际港务(集团)股份有限公司 | 一种动态环境下的自动导引运输车路径规划方法 |
CN112432652B (zh) * | 2021-01-26 | 2021-04-06 | 德鲁动力科技(成都)有限公司 | 路径规划系统及路径规划方法 |
CN113022586B (zh) * | 2021-04-14 | 2022-08-02 | 福瑞泰克智能系统有限公司 | 一种车辆行为预测方法、装置及存储介质 |
CN113639750B (zh) * | 2021-07-20 | 2023-05-26 | 中国地质大学(武汉) | 顾及时变需求的高峰时段无人机监视路径规划方法及装置 |
CN115080673B (zh) * | 2021-12-02 | 2025-04-01 | 南京晓庄学院 | 基于多级比例尺交通网络的动态目标轨迹索引方法 |
CN115586769A (zh) * | 2022-08-29 | 2023-01-10 | 国网江苏省电力有限公司信息通信分公司 | 移动机器人路径规划方法和系统 |
CN116610129B (zh) * | 2023-07-17 | 2023-09-29 | 山东优宝特智能机器人有限公司 | 一种腿足机器人的局部路径规划方法及系统 |
CN117746556B (zh) * | 2023-11-28 | 2024-11-22 | 江苏中科朗润智能科技有限公司 | 一种基于红外技术的智能穿戴设备危险感知方法及系统 |
CN117705140B (zh) * | 2024-02-04 | 2024-05-10 | 航天宏图信息技术股份有限公司 | 基于多时相可通过性的动态路径规划方法、装置及设备 |
CN118031997B (zh) * | 2024-04-15 | 2024-07-12 | 航天广通科技(深圳)有限公司 | 基于gis的空间地理信息服务方法及装置 |
CN119283043B (zh) * | 2024-12-10 | 2025-03-07 | 杭州旗晟智能科技有限公司 | 多股道场景下地铁车辆巡检机器人导航方法、装置以及可读存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5410485A (en) * | 1992-10-22 | 1995-04-25 | Alpine Electronics, Inc. | Navigation apparatus and method for exploring an optimal route based on characteristics of an exploration object zone |
CN101313199A (zh) * | 2005-10-06 | 2008-11-26 | 通用汽车环球科技运作公司 | 根据群组分析的最优路线计算 |
CN102778229A (zh) * | 2012-05-31 | 2012-11-14 | 重庆邮电大学 | 未知环境下基于改进蚁群算法的移动Agent路径规划方法 |
CN103278170A (zh) * | 2013-05-16 | 2013-09-04 | 东南大学 | 基于显著场景点检测的移动机器人级联地图创建方法 |
-
2014
- 2014-05-23 CN CN201410222902.XA patent/CN103994768B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5410485A (en) * | 1992-10-22 | 1995-04-25 | Alpine Electronics, Inc. | Navigation apparatus and method for exploring an optimal route based on characteristics of an exploration object zone |
CN101313199A (zh) * | 2005-10-06 | 2008-11-26 | 通用汽车环球科技运作公司 | 根据群组分析的最优路线计算 |
CN102778229A (zh) * | 2012-05-31 | 2012-11-14 | 重庆邮电大学 | 未知环境下基于改进蚁群算法的移动Agent路径规划方法 |
CN103278170A (zh) * | 2013-05-16 | 2013-09-04 | 东南大学 | 基于显著场景点检测的移动机器人级联地图创建方法 |
Non-Patent Citations (1)
Title |
---|
移动机器人智能体混合式体系结构研究;李彩虹;《中国博士学位论文全文数据库信息科技辑》;20080715(第7期);I140-15 * |
Also Published As
Publication number | Publication date |
---|---|
CN103994768A (zh) | 2014-08-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103994768B (zh) | 动态时变环境下寻求全局时间最优路径的方法及系统 | |
CN106371445B (zh) | 一种基于拓扑地图的无人车规划控制方法 | |
CN109491377A (zh) | 用于自动驾驶车辆的基于dp和qp的决策和规划 | |
CN109489675A (zh) | 用于自动驾驶车辆的基于成本的路径规划 | |
CN109949604B (zh) | 一种大型停车场调度导航方法及系统 | |
CN109491376A (zh) | 用于自动驾驶车辆的基于动态规划和梯度下降的决策和规划 | |
Van Toll et al. | Real‐time density‐based crowd simulation | |
CN110389581A (zh) | 用于为自动驾驶车辆生成障碍物的预测轨迹的方法 | |
CN109947090A (zh) | 用于自动驾驶车辆规划的非阻塞边界 | |
CN102176283B (zh) | 一种简化交通路网模型的导航方法 | |
JP5789268B2 (ja) | 経路選択システム、方法及びプログラム | |
CN104541528B (zh) | 用于映射移动设备的路线的方法、装置和系统 | |
US8935096B2 (en) | Apparatus for fast path search by learning heuristic function and method thereof | |
CN110345955A (zh) | 用于自动驾驶的感知与规划协作框架 | |
CN102155942B (zh) | 大范围环境下基于模糊拓扑地图的全局路径规划方法 | |
CN109521762A (zh) | 用于自动驾驶车辆的基于2d约束平滑样条的平滑道路参考线路 | |
CN110389585A (zh) | 用于自动驾驶车辆的基于学习的速度规划器 | |
CN109521763A (zh) | 用于自动驾驶车辆的基于约束平滑样条的路径优化 | |
CN108444482A (zh) | 一种无人机自主寻路避障方法及系统 | |
CN110325935A (zh) | 用于自动驾驶车辆的路径规划的基于驾驶场景的车道引导线 | |
CN110488842B (zh) | 一种基于双向内核岭回归的车辆轨迹预测方法 | |
CN109094573A (zh) | 用于确定自动驾驶车辆的控制器的最佳系数的方法和系统 | |
CN112183710A (zh) | 确定路径的方法及装置 | |
KR101299134B1 (ko) | 다수 로봇의 협력을 통한 동적 환경에서의 동적 목표물 탐색 시스템 및 방법 | |
CN113433937B (zh) | 基于启发式探索的分层导航避障系统、分层导航避障方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20140820 Assignee: Beijing Bingfeng Technology Co.,Ltd. Assignor: Beijing Jiaotong University Contract record no.: X2021990000702 Denomination of invention: Method and system for seeking global time optimal path in dynamic time-varying environment Granted publication date: 20170125 License type: Common License Record date: 20211118 |
|
EE01 | Entry into force of recordation of patent licensing contract |