[发明专利]井下交通灯控制方法

说明书

本发明公开了一种井下交通灯控制方法，先寻找需要控制的红绿灯组G _target，再从G _target中寻找需要控制的红绿灯L _target，最后请求控制中心将L _target变为绿灯、G _target组内其它红绿灯变为红灯。从所有红绿灯组中寻找红绿灯组G _targe时，是以车辆运行方向向量与车辆当前位置至待选红绿灯组的向量之间的夹角最小为原则；从G _target中寻找红绿灯L _target时，是以车辆运行方向向量与车辆当前位置至待选红绿灯的向量之间的夹角最小为原则。本发明通过计算夹角来选择方向最接近的红绿灯组或红绿灯作为控制目标，消除了最近原则所带来的选择不当的问题，保证了车辆的安全运行。

技术领域

本发明涉及一种控制井下交通灯的方法。

背景技术

目前井下红绿灯调度算法中，车辆行驶过程中需要控制红绿灯时，会根据车辆上安装的定位标签获得实时定位位置信息，然后以此位置信息为圆心，先寻找指定范围内的最近的红绿灯组（一般一个红绿灯组由若干个红绿灯构成），然后再从最近红绿灯组内查找最近的红绿灯作为调度车辆需要控制的目标交通灯。最后通知控制中心将此灯设为绿灯，该最近红绿灯组内的其它灯设为红灯。车辆看到绿灯，表明其可以通过该路口，该路口其它方向的车辆看到的是红灯，无法通过红绿灯范围。

然而，现有的控制方式经常出现所控制的红绿灯并非当前所要通过的红绿灯的情况，导致调度出错，影响井下车辆的安全运行。

典型场景一如图1所示：车辆拟通过1处路口，但由于井下巷道的复杂性，车辆在查找待控制的红绿灯组时，发现2处的红绿灯组与车辆之间的距离小于本该控制的1处红绿灯组与车辆之间的距离。根据距离最近的原则，最终请求系统控制2处红绿灯组中最近的红绿灯，导致车辆在经过1处时无法通行。同时2处红绿灯组中的最近的红绿灯被误设置绿灯，很容易引起交通事故。

典型场景二如图2所示：3处红绿灯与4处红绿灯同属一个红绿灯组，车辆先经过3处，当前应控制3处红绿灯。但是，由于4处红绿灯与车辆之间的距离小于3处红绿灯与车辆件的距离，根据距离最近的原则，车辆最终请求控制4处红绿灯，导致车辆在经过3处时无法通行。同时4处红绿灯被误设置绿灯，很容易引起交通事故。

发明内容

本发明提出了一种井下交通灯控制方法，其目的是：根据车辆位置寻找到正确的红绿灯组及组内正确的红绿灯进行调度控制，保证井下车辆的安全运行。

本发明技术方案如下：

一种井下交通灯控制方法，先寻找需要控制的红绿灯组G_target，再从G_target中寻找需要控制的红绿灯L_target，最后请求控制中心将L_target变为绿灯、G_target组内其它红绿灯变为红灯；

从所有红绿灯组中寻找红绿灯组G_target时，是以车辆运行方向向量与车辆当前位置至待选红绿灯组的向量之间的夹角最小为原则；

从G_target中寻找红绿灯L_target时，是以车辆运行方向向量与车辆当前位置至待选红绿灯的向量之间的夹角最小为原则。

作为所述的井下交通灯控制方法的进一步改进：设车辆当前的定位位置是A（,），车辆上一次定位的位置是B（,），则车辆运行方向向量=(,)；

寻找红绿灯组G_target时，设共有k组可控制的红绿灯组，位置分别为（,），i=1,2…k，则车辆当前位置至各待选红绿灯组的向量分别为：=(,)；

先计算各向量点积，判断是否大于0：

=(-)*()+(-)*()，其中i=1,2…k；