地图并判断以下匹配条件是否均已满足:
[0068]双目相机检测的交通标示牌与高精度驾驶地图的交通标示牌的类型是否一致；
[0069]双目相机检测的交通标示牌与高精度驾驶地图的交通标示牌的交通标示牌的方位是否一致；
[0070]汽车推算位置与高精度驾驶地图中搜索的交通标示牌角度值的角度差值是否小于预设角度差值；
[0071]汽车推算位置与高精度驾驶地图中交通标示牌的的距离是否小于预设纵向距离差值;
[0072]汽车推算位置与高精度驾驶地图中交通标示牌的横向距离是否小于预设横向距离差值；
[0073]找出高精度地图中满足匹配条件的交通标示牌作为匹配的交通标示牌。
[0074]可选地，所述步骤S4中根据交通标示牌的经玮度坐标信息、汽车车标与匹配的交通标示牌之间的角度信息、汽车推算位置信息来获得汽车的位置包括:
[0075]据交通标示牌的经玮度坐标信息、汽车与交通标示牌的角度、汽车与交通标识牌的距离信息，获取汽车的推算坐标；
[0076]将汽车的推算坐标投影到当前的车道线。
[0077]可选地，所述步骤S5中根据补正后的汽车的位置进行车道线匹配包括:
[0078]判断当前匹配是否为第一次匹配车道线；
[0079]在当前匹配为第一次匹配车道线时:通过汽车的位置，在高精度驾驶地图数据中检索相应的车道区间，并计算最近的车道线，保存车道信息的逻辑位置，逻辑信息包括当前车道、左车道、右车道；
[0080]在当前匹配不是第一次匹配车道线时:判断双目相机输出的LD、RD是否有效:如果有效，通过LD、RD的跳变判断变道事件；如果无效，通过推算点的位置判断变道事件；重新计算并保存车道信息的逻辑位置，逻辑信息包括当前车道、左车道、右车道；
[0081]输出当前车道、左车道、右车道信息。
[0082]结合本文中所公开的实施例描述的方法或算法的步骤可以直接用硬件、处理器执行的软件模块，或者二者的结合来实施。软件模块可以置于随机储存器、内存、只读存储器、电可编程R0M、电可擦除可编程R0M、寄存器、硬盘、可移动磁盘、CD-ROM、或技术领域内所公知的任意其他形式的存储介质中。
[0083]可以理解的是，对于本领域的普通技术人员来说，可以根据本发明的技术构思做出其它各种相应的改变与变形，而所有这些改变与变形都应属于本发明权利要求的保护范围。
【主权项】
1.一种利用交通标示牌的坐标反推汽车自身位置的系统，其特征在于，其包括如下单元: 信息获取单元，用于获取汽车自身行驶信息、交通标示牌信息；并根据汽车自身行驶信息、交通标示牌信息获得汽车推算位置信息； 匹配单元，用于在高精度驾驶地图中匹配双目相机所检测到的交通标示牌； 坐标确定单元，用于获取匹配的交通标示牌的经玮度坐标信息； 汽车位置定位单元，用于根据交通标示牌的经玮度坐标信息、汽车车标与匹配的交通标示牌之间的角度信息、汽车推算位置信息来获得汽车的位置，并将汽车的位置投影到行驶车道的中心线上； 车道线匹配单元，用于通过汽车与行驶车道的两侧的距离信息对汽车的位置进行横向补正；并根据补正后的汽车的位置进行车道线匹配。2.如权利要求1所述的利用交通标示牌的坐标反推汽车自身位置的系统，其特征在于，所述信息获取单元中根据汽车自身行驶信息、交通标示牌信息获得汽车推算位置信息包括: 通过CAN总线采集单位时间内的汽车的瞬间车速，并计算出瞬间行驶距离，然后不断地累加瞬间行驶距离，并判断累加的瞬间行驶距离是否大于预设瞬间行驶距离阈值，输出大于预设瞬间行驶距离阈值的累加的瞬间行驶距离； 不断地接收汽车上双目相机输出的相机与行驶车道的左侧距离值LD、相机与行驶车道的右侧距离值RD，并判断LD、RD是否有效，如果LD、RD有效则通过高精度驾驶地图数据校正LD、RD，并通过校正后的LD、RD结合累加的瞬间行驶距离，计算出汽车推算位置；如果LD、RD无效，则输出GPS角度值，并结合累加的瞬间行驶距离，计算出汽车推算位置。3.如权利要求2所述的利用交通标示牌的坐标反推汽车自身位置的系统，其特征在于，所述匹配单元包括: 接收双目相机获取的交通标示牌的类型信息、交通标示牌的方位信息、汽车与交通标示牌之间的角度值信息、汽车与交通标示牌的距离信息、汽车与交通标示牌的横向距离信息，遍历高精度驾驶地图并判断以下匹配条件是否均已满足: 双目相机检测的交通标示牌与高精度驾驶地图的交通标示牌的类型是否一致； 双目相机检测的交通标示牌与高精度驾驶地图的交通标示牌的交通标示牌的方位是否一致； 汽车推算位置与高精度驾驶地图中搜索的交通标示牌角度值的角度差值是否小于预设角度差值； 汽车推算位置与高精度驾驶地图中交通标示牌的的距离是否小于预设纵向距离差值； 汽车推算位置与高精度驾驶地图中交通标示牌的横向距离是否小于预设横向距离差值； 找出高精度地图中满足匹配条件的交通标示牌作为匹配的交通标示牌。4.如权利要求3所述的利用交通标示牌的坐标反推汽车自身位置的系统，其特征在于，所述汽车位置定位单元中根据交通标示牌的经玮度坐标信息、汽车车标与匹配的交通标示牌之间的角度信息、汽车推算位置信息来获得汽车的位置包括: 据交通标示牌的经玮度坐标信息、汽车与交通标示牌的角度、汽车与交通标识牌的距离信息，获取汽车的推算坐标； 将汽车的推算坐标投影到当前的车道线。5.如权利要求4所述的利用交通标示牌的坐标反推汽车自身位置的系统，其特征在于，所述车道线匹配单元中根据补正后的汽车的位置进行车道线匹配包括: 判断当前匹配是否为第一次匹配车道线； 在当前匹配为第一次匹配车道线时:通过汽车的位置，在高精度驾驶地图数据中检索相应的车道区间，并计算最近的车道线，保存车道信息的逻辑位置，逻辑信息包括当前车道、左车道、右车道； 在当前匹配不是第一次匹配车道线时:判断双目相机输出的LD、RD是否有效:如果有效，通过LD、RD的跳变判断变道事件；如果无效，通过推算点的位置判断变道事件；重新计算并保存车道信息的逻辑位置，逻辑信息包括当前车道、左车道、右车道； 输出当前车道、左车道、右车道信息。6.一种利用交通标示牌的坐标反推汽车自身位置的方法，其特征在于，其包括如下步骤: 51、获取汽车自身行驶信息、交通标示牌信息；并根据汽车自身行驶信息、交通标示牌信息获得汽车推算位置信息； 52、在高精度驾驶地图中匹配双目相机所检测到的交通标示牌； 53、获取匹配的交通标示牌的经玮度坐标信息； 54、根据交通标示牌的经玮度坐标信息、汽车车标与匹配的交通标示牌之间的角度信息、汽车推算位置信息来获得汽车的位置，并将汽车的位置投影到行驶车道的中心线上； 55、通过汽车与行驶车道的两侧的距离信息对汽车的位置进行横向补正；并根据补正后的汽车的位置进行车道线匹配。7.如权利要求6所述的利用交通标示牌的坐标反推汽车自身位置的方法，其特征在于，所述步骤SI中根据汽车自身行驶信息、交通标示牌信息获得汽车推算位置信息包括: 通过CAN总线采集单位时间内的汽车的瞬间车速，并计算出瞬间行驶距离，然后不断地累加瞬间行驶距离，并判断累加的瞬间行驶距离是否大于预设瞬间行驶距离阈值，输出大于预设瞬间行驶距离阈值的累加的瞬间行驶距离； 不断地接收汽车上双目相机输出的相机与行驶车道的左侧距离值LD、相机与行驶车道的右侧距离值RD，并判断LD、RD是否有效，如果LD、RD有效则通过高精度驾驶地图数据校正LD、RD，并通过校正后的LD、RD结合累加的瞬间行驶距离，计算出汽车推算位置；如果LD、RD无效，则输出GPS角度值，并结合累加的瞬间行驶距离，计算出汽车推算位置。8.如权利要求7所述的利用交通标示牌的坐标反推汽车自身位置的方法，其特征在于，所述步骤S2包括: 接收双目相机获取的交通标示牌的类型信息、交通标示牌的方位信息、汽车与交通标示牌之间的角度值信息、汽车与交通标示牌的距离信息、汽车与交通标示牌的横向距离信息，遍历高精度驾驶地图并判断以下匹配条件是否均已满足: 双目相机检测的交通标示牌与高精度驾驶地图的交通标示牌的类型是否一致； 双目相机检测的交通标示牌与高精度驾驶地图的交通标示牌的交通标示牌的方位是否一致； 汽车推算位置与高精度驾驶地图中搜索的交通标示牌角度值的角度差值是否小于预设角度差值； 汽车推算位置与高精度驾驶地图中交通标示牌的的距离是否小于预设纵向距离差值； 汽车推算位置与高精度驾驶地图中交通标示牌的横向距离是否小于预设横向距离差值； 找出高精度地图中满足匹配条件的交通标示牌作为匹配的交通标示牌。9.如权利要求8所述的利用交通标示牌的坐标反推汽车自身位置的方法，其特征在于，所述步骤S4中根据交通标示牌的经玮度坐标信息、汽车车标与匹配的交通标示牌之间的角度信息、汽车推算位置信息来获得汽车的位置包括: 据交通标示牌的经玮度坐标信息、汽车与交通标示牌的角度、汽车与交通标识牌的距离信息，获取汽车的推算坐标； 将汽车的推算坐标投影到当前的车道线。10.如权利要求9所述的利用交通标示牌的坐标反推汽车自身位置的方法，其特征在于，所述步骤S5中根据补正后的汽车的位置进行车道线匹配包括: 判断当前匹配是否为第一次匹配车道线； 在当前匹配为第一次匹配车道线时:通过汽车的位置，在高精度驾驶地图数据中检索相应的车道区间，并计算最近的车道线，保存车道信息的逻辑位置，逻辑信息包括当前车道、左车道、右车道； 在当前匹配不是第一次匹配车道线时:判断双目相机输出的LD、RD是否有效:如果有效，通过LD、RD的跳变判断变道事件；如果无效，通过推算点的位置判断变道事件；重新计算并保存车道信息的逻辑位置，逻辑信息包括当前车道、左车道、右车道； 输出当前车道、左车道、右车道信息。
【专利摘要】一种利用交通标示牌的坐标反推汽车自身位置的系统，其包括如下单元：信息获取单元，用于获取汽车自身行驶信息、交通标示牌信息；并根据汽车自身行驶信息、交通标示牌信息获得汽车推算位置信息；匹配单元，用于在高精度驾驶地图中匹配双目相机所检测到的交通标示牌；坐标确定单元，用于获取匹配的交通标示牌的经纬度坐标信息；汽车位置定位单元，用于根据交通标示牌的经纬度坐标信息、汽车车标与匹配的交通标示牌之间的角度信息、汽车推算位置信息来获得汽车的位置，并将汽车的位置投影到行驶车道的中心线上；车道线匹配单元，用于通过汽车与行驶车道的两侧的距离信息对汽车的位置进行横向补正；并根据补正后的汽车的位置进行车道线匹配。
【IPC分类】G01C21/28
【公开号】CN105021201
【申请号】CN201510502600
【发明人】邓前飞
【申请人】武汉光庭信息技术有限公司
【公开日】2015年11月4日
【申请日】2015年8月17日