[发明专利]利用交通标示牌的坐标反推汽车自身位置的系统及方法

权利要求书

1.一种利用交通标示牌的坐标反推汽车自身位置的系统，其特征在于，其包括如下单元：

信息获取单元，用于获取汽车自身行驶信息、交通标示牌信息；并根据汽车自身行驶信息、交通标示牌信息获得汽车推算位置信息；

匹配单元，用于在高精度驾驶地图中匹配双目相机所检测到的交通标示牌；

坐标确定单元，用于获取匹配的交通标示牌的经纬度坐标信息；

汽车位置定位单元，用于根据交通标示牌的经纬度坐标信息、汽车车标与匹配的交通标示牌之间的角度信息、汽车推算位置信息来获得汽车的位置，并将汽车的位置投影到行驶车道的中心线上；

车道线匹配单元，用于通过汽车与行驶车道的两侧的距离信息对汽车的位置进行横向补正；并根据补正后的汽车的位置进行车道线匹配；

所述信息获取单元中根据汽车自身行驶信息、交通标示牌信息获得汽车推算位置信息包括：

通过CAN总线采集单位时间内的汽车的瞬间车速，并计算出瞬间行驶距离，然后不断地累加瞬间行驶距离，并判断累加的瞬间行驶距离是否大于预设瞬间行驶距离阈值，输出大于预设瞬间行驶距离阈值的累加的瞬间行驶距离；

不断地接收汽车上双目相机输出的相机与行驶车道的左侧距离值LD、相机与行驶车道的右侧距离值RD，并判断LD、RD是否有 效，如果LD、RD有效则通过高精度驾驶地图数据校正LD、RD，并通过校正后的LD、RD结合累加的瞬间行驶距离，计算出汽车推算位置；如果LD、RD无效，则输出GPS角度值，并结合累加的瞬间行驶距离，计算出汽车推算位置。

2.如权利要求1所述的利用交通标示牌的坐标反推汽车自身位置的系统，其特征在于，所述匹配单元包括：

接收双目相机获取的交通标示牌的类型信息、交通标示牌的方位信息、汽车与交通标示牌之间的角度值信息、汽车与交通标示牌的距离信息、汽车与交通标示牌的横向距离信息，遍历高精度驾驶地图并判断以下匹配条件是否均已满足：

双目相机检测的交通标示牌与高精度驾驶地图的交通标示牌的类型是否一致；

双目相机检测的交通标示牌与高精度驾驶地图的交通标示牌的交通标示牌的方位是否一致；

汽车推算位置与高精度驾驶地图中搜索的交通标示牌角度值的角度差值是否小于预设角度差值；

汽车推算位置与高精度驾驶地图中交通标示牌的的距离是否小于预设纵向距离差值；

汽车推算位置与高精度驾驶地图中交通标示牌的横向距离是否小于预设横向距离差值；

找出高精度地图中满足匹配条件的交通标示牌作为匹配的交通标示牌。

3.如权利要求2所述的利用交通标示牌的坐标反推汽车自身位置的系统，其特征在于，所述汽车位置定位单元中根据交通标示牌的经纬度坐标信息、汽车车标与匹配的交通标示牌之间的角度信息、汽车推算位置信息来获得汽车的位置包括：

据交通标示牌的经纬度坐标信息、汽车与交通标示牌的角度、汽车与交通标识牌的距离信息，获取汽车的推算坐标；

将汽车的推算坐标投影到当前的车道线。

4.如权利要求3所述的利用交通标示牌的坐标反推汽车自身位置的系统，其特征在于，所述车道线匹配单元中根据补正后的汽车的位置进行车道线匹配包括：

判断当前匹配是否为第一次匹配车道线；

在当前匹配为第一次匹配车道线时：通过汽车的位置，在高精度驾驶地图数据中检索相应的车道区间，并计算最近的车道线，保存车道信息的逻辑位置，逻辑信息包括当前车道、左车道、右车道；

在当前匹配不是第一次匹配车道线时：判断双目相机输出的LD、RD是否有效：如果有效，通过LD、RD的跳变判断变道事件；如果无效，通过推算点的位置判断变道事件；重新计算并保存车道信息的逻辑位置，逻辑信息包括当前车道、左车道、右车道；

输出当前车道、左车道、右车道信息。