利用数码相机为车辆提供动态路径规划实现导航的方法技术

本发明专利技术涉及一种利用数码相机为车辆提供动态路径规划实现导航的方法，主要步骤如下：（１）设有两种供用户选择的功能状态，分别为数码功能和导航功能，选择导航功能进入相应导航界面；（２）开机初始化；（３）依据初始化获得的地图数据进行扫描搜索；代价标准和代价函数的建立，评价函数的计算，开始路径规划；（４）将路径规划的结果记录，并将选择的路段显示在数码相机的ＬＣＤ屏上；（５）计算选择路段的总长度，根据由汽车速度传感器获得的当前速度估算车辆到达目的地所需要的时间。本发明专利技术在原有ＧＰＳ数码相机的基础上，增加了路径导航功能，不但能为出行者指引道路，还能够让驾驶员驾驶车辆有效地避开交通阻塞的道路，既省油又节约时间，更加实用。

【技术实现步骤摘要】

本专利技术涉及利用数码相机实现车辆导航的方法，特别涉及一种。
技术介绍
近年来，随着数码相机技术水平的不断提高，数码相机的基本属性功能已日趋完善，因此，数码相机不可避免的开始走向多功能的道路。另一方面，随着生活水平的日益提高，汽车逐渐成为生活中不可缺少的交通工具，然而，随着道路上车辆数目的不断增多，势必会导致交通阻塞现象，给人们的出行造成负担。 在相机集成化功能发展的同时，爱国者数码相机已经推出了在数码相机中融入GPS定位导航功能，可以使相机实时的追踪到现实车辆，并通过卫星定位车辆的位置，将车辆的行驶路线显示在数码相机的LCD屏中，让驾驶员实时观测，这便能够让驾驶者轻松的了解自己车辆所处的位置，为其提供行进的方便。但是，这种定位导航功能只能够单一的反映车辆的位置，而在现代的智能交通系统中，对于出行者来说，最重要的并不是仅仅让他了解其所在的位置，而是有助其找到到达目的地的最优路径。
技术实现思路
本专利技术的目的在于克服上述不足之处，提供一种。本专利技术正是基于这一方面问题，在数码相机原有的系统中增加智能导航模块，以此为出行者提供其要到达目的地的最优路径，使其用最短的时间、最短的行程距离到达目的地。 为实现上述目的本专利技术所采用的实施方式如下 一种，实施步骤如下 步骤一相机开机后，设有两种供用户选择的功能状态，分别为数码功能和导航功能，选择导航功能进入相应导航界面； 步骤二开机初始化； 步骤三依据初始化获得的地图数据进行扫描搜索；代价标准和代价函数的建立，评价函数的计算，开始路径规划； 步骤四将路径规划的结果记录，并将选择的路段显示在数码相机的LCD屏上； 步骤五计算选择路段的总长度，根据由汽车速度传感器获得的当前速度估算车辆到达目的地所需要的时间； 所述步骤二开机初始化包括如下步骤 (1)针对电子地图建立初始路网的邻接表； 所述电子地图中的每个地点都用一个顶点表示，每个地点相连的道路用一条边来表示，这样，地图中的地点和道路的关系就抽象成为了点与边的关系； 其中，第一列表示的是顶点表，其余的表示的是边表；它所占用的空间为O(n+e)，其中n表示结点的个数，e表示的是边的条数； (2)进行初始化； 导航功能在加电启动后，首先导航协议及表示功能状态的状态位置0，全局变量完成赋初值后唤醒通讯消息管理进程，并修改任务队列相应活动状态位，并循环加电登录直到加电成功，若不成功则无法向下进行；完成加电初始化后进入暂停状态，开始接受有效的卫星定位信号，相机上传协议函数后定位初始化完成，唤醒上传定位数据后进入休眠状态，初始化结束； 步骤三路径规划包括如下步骤 (1)定义道路网模型如下 任意一条有向道路Ri的数据模型定义为 其中，Si、Ti分别为道路的起始结点和终止结点；在离散时间的w时刻，该道路的车辆行驶速度为Viw，车辆累积量为niw，流入量为Iiw，流出量为Oiw； (2)将道路的代价函数分成静态Cg和动态Cq两个部分，每台车辆在某个时刻t根据随机产生的起始结点(Sm或Sn)和目标结点(Em或En)，利用规划函数产生任务序列结点，车辆的数据模型定义为 其中，在离散时间的w时刻某车辆位于Riw道路上的Kiw位置；μ为一个常数，0≤μ≤1； 任意一辆普通车辆在w时刻的行为定义为 K′mw＝Knw+Viw×Δt 若K′mw∈Riw，则Km(w+1)＝K′mw； 否则按照规划的序列重新计算Rjw和对应的坐标K″mw； 若njw＜njmax，则否则Km(w+1)＝Kmw或重新规划； njmax表示一条道路上所能容纳的最大车辆数；导航车辆的行为定义仿照普通车辆的进行； 利用路径规划的结果数据进行导航的详细流程如下 (1)为相关的变量赋初值，初始化工作表； (2)设置导航数据； (3)得到当前车辆位置； (4)判断其当前的引导方式； 对上述流程中相关的导航数据处理的详细步骤如下 (1)根据GPS信息判断车辆是否在道路上；通过地图匹配技术比较车辆的位置与所在路段的关系，若偏离则进入导航暂停状态或者强行中止导航； (2)车辆未发生离路，处于正常行驶状态，即判断其引导的方式，并选择其下一个应到达的节点作为下一步的初始节点； (3)判断下一个节点是否为目的地节点，如果下一个节点即为其目的地节点，则车辆停止，并发送“完成”的导航数据；否则继续导航，发送标识导航数据后返回(1)； (4)释放空间。 本专利技术的有益效果是本专利技术在原有GPS数码相机的基础上，增加了交通路径导航功能，不但能为出行者指引道路，还能够让引导驾驶员驾驶车辆有效地避开交通阻塞的道路，既省油又节约时间，更加贴近生活，利用该方法导航车辆，安全可靠，安全实用。 本专利技术可直接利用现有的数码相机硬件资源，无需增加任何硬件成本，且能给用户带来极大的便利。总之，本专利技术构思合理，效果显著，使用方便，应用广泛。 附图说明 图1是本专利技术方法针对电子地图建立初始路网的邻接表示意图； 图2是本专利技术方法初始化流程图； 图3是本专利技术方法导航步骤流程图； 图4是本专利技术方法导航处理流程图。 具体实施例方式 以下结合附图和较佳实施例，对依据本专利技术提供的具体实施方式、特征详述如下 参见图1-图4，一种，实施步骤如下 步骤一相机开机后，设有两种供用户选择的功能状态，分别为数码功能和导航功能，选择导航功能进入相应导航界面； 步骤二开机初始化； 步骤三依据初始化获得的地图数据进行扫描搜索；代价标准和代价函数的建立，评价函数的计算，开始路径规划； 步骤四将路径规划的结果记录，并将选择的路段显示在数码相机的LCD屏上； 步骤五计算选择路段的总长度，根据由汽车速度传感器获得的当前速度估算车辆到达目的地所需要的时间； 所述步骤二开机初始化包括如下步骤 (1)针对电子地图建立初始路网的邻接表； 参见图1，所述电子地图中的每个地点都用一个顶点表示，每个地点相连的道路用一条边来表示；这样，地图中的地点和道路的关系就抽象成为了点与边的关系； 其中，第一列表示的是顶点表，其余的表示的是边表；它所占用的空间为O(n+e)，其中n表示结点的个数，e表示的是边的条数； (2)进行初始化； 导航功能在加电启动后，首先导航协议及表示功能状态的状态位置0，全局变量完成赋初值后唤醒通讯消息管理进程，并修改任务队列相应活动状态位，并循环加电登录直到加电成功，若不成功则无法向下进行；完成加电初始化后进入暂停状态，开始接受有效的卫星定位信号，相机上传协议函数后定位初始化完成，唤醒上传定位数据后进入休眠状态，初始化结束； 步骤三路径规划包括如下步骤 (1)定义道路网模型如下 任意一条有向道路Ri的数据模型定义为 其中，Si、Ti分别为道路的起始结点和终止结点；在离散时间的w时刻，该道路的车辆行驶速度为Viw，车辆累积量为niw，流入量为Iiw，流出量为Oiw； (2)将道路的代价函数分成静态Cg和动态Cp两个部分，每台车辆在某个时刻t根据随机产生的起始结点(Sm或Sn)和目标本文档来自技高网...

【技术保护点】
一种利用数码相机为车辆提供动态路径规划实现导航的方法，实施步骤如下：　步骤一：相机开机后，设有两种供用户选择的功能状态，分别为数码功能和导航功能，选择导航功能进入相应导航界面；　步骤二：开机初始化；　步骤三：依据初始化获得 的地图数据进行扫描搜索；代价标准和代价函数的建立，评价函数的计算，开始路径规划；　步骤四：将路径规划的结果记录，并将选择的路段显示在数码相机的ＬＣＤ屏上；　步骤五：计算选择路段的总长度，根据由汽车速度传感器获得的当前速度估算车辆 到达目的地所需要的时间；　所述利用数码相机为车辆提供动态路径规划实现导航的方法步骤二开机初始化包括如下步骤：　（１）针对电子地图建立初始路网的邻接表；　所述电子地图中的每个地点都用一个顶点表示，每个地点相连的道路用一条边来 表示，电子地图中的地点和道路的关系抽象为点与边的关系；　其中，第一列表示的是顶点表，其余的表示的是边表；它所占用的空间为Ｏ（ｎ＋ｅ），其中ｎ表示结点的个数，ｅ表示的是边的条数；　（２）进行初始化；　导航功能在加电启动后，首 先导航协议及表示功能状态的状态位置０，全局变量完成赋初值后唤醒通讯消息管理进程，并修改任务队列相应活动状态位，并循环加电登录直到加电成功，若不成功则无法向下进行；完成加电初始化后进入暂停状态，开始接受有效的卫星定位信号，相机上传协议函数后定位初始化完成，唤醒上传定位数据后进入休眠状态，初始化结束；　所述利用数码相机为车辆提供动态路径规划实现导航的方法步骤三路径规划包括如下步骤：　（１）定义道路网模型如下：　＊＊＊　任意一条有向道路Ｒ↓［ｉ］的数据模型定 义为：　＊＊＊　其中，Ｓ↓［ｉ］、Ｔ↓［ｉ］分别为道路的起始结点和终止结点；在离散时间的ｗ时刻，该道路的车辆行驶速度为Ｖ↓［ｉｗ］，车辆累积量为ｎ↓［ｉｗ］，流入量为Ｌ↓［ｉｗ］，流出量为Ｏ↓［ｉｗ］；　（２）将道路的代价 函数分成静态Ｃ↓［ｇ］和动态Ｃ↓［ｐ］两个部分，每台车辆在某个时刻ｔ根据随机产生的起始结点（Ｓ↓［ｍ］或Ｓ↓［ｎ］）和目标结点（Ｅ↓［ｍ］或Ｅ↓［ｎ］），利用规划函数产生任务序列结点，车辆的数据模型定义为：　＊＊＊　其中，在离散 时间的ｗ时刻某车辆位于Ｒ↓［ｉｗ］道路上的Ｋ↓［ｉｗ］位置；μ为一个常数，０≤μ≤１；　任意一辆普通车辆在ｗ时刻的行为定义为：...

【技术特征摘要】

【专利技术属性】
技术研发人员：苏野，郑龙周，
申请(专利权)人：天津三星光电子有限公司，
类型：发明
国别省市：12[中国|天津]