汽车协同编队行驶的动态路径规划方法

摘要

本发明涉及一种汽车协同编队行驶的动态路径规划方法，包括：步骤10，判断是否到达目的地，如果未到达目的，则执行步骤20；步骤20，判断头车是否到达路口，如果头车到达路口，执行步骤30；步骤30，采用SPFA算法确定初始最短路径；步骤40，获取当前路口所有汽车的信息；步骤50，用Fuzzy编队算法判断当前路口是否适合编队，如果适合编队，执行步骤60，否则执行步骤70；步骤60，控制汽车在目标路段形成编队；步骤70，更新源路段和路段的相关信息；步骤80，执行步骤10。本发明提高道路交通的安全性、道路的通行能力、节约能源、减轻驾驶员的劳动强度、提高其舒适度，这样可以使道路容量尽可能的加大，使行驶尽可能的通畅。

主权项

一种汽车协同编队行驶的动态路径规划方法，其特征在于，包括：步骤10，判断是否到达目的地，如果未到达目的，则执行步骤20；步骤20，判断头车是否到达路口，如果头车到达路口，执行步骤30；步骤30，采用SPFA算法确定初始最短路径；步骤40，获取当前路口所有汽车的信息；步骤50，用Fuzzy编队算法判断所述当前路口是否适合编队，如果适合编队，执行步骤60，否则执行步骤70；步骤60，控制汽车在目标路段形成编队；步骤70，更新源路段和路段的相关信息；步骤80，执行步骤10。