欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 202010347592X
申请人: 吉林大学
专利类型:发明专利
专利状态:未下证
专利领域: 测量;测试
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种基于OCC的自动驾驶车辆跟踪定位方法,其特征在于包括以下步骤:步骤1)将光源LED在世界坐标系中的位置坐标经曼彻斯特编码和OOK调制后通过驱动电路驱动光源LED发出高速明暗变化的可见光信号;

步骤2)自动驾驶车辆通过车载CMOS图像传感器获取包含至少一个光源LED信息的图像,利用霍夫圆变换检测图像中的LED光斑;

步骤3)对检测出的LED光斑进行跟踪解码,得到至少一个光源LED在世界坐标系中的位置坐标;

步骤4)根据光源LED在世界坐标系中的位置坐标计算自动驾驶车辆位置信息,方法如下:(1)建立三个主要坐标系:世界坐标系、图像坐标系和相机坐标系;世界坐标系(Xw,Yw,Zw)是3D空间的基准坐标系;图像坐标系(x,y)的横纵坐标轴分别平行于成像平面的长和宽,坐标原点为图像中心;相机坐标系(Xc,Yc,Zc)的Zc轴为相机光轴,Xc,Yc轴分别平行于图像坐标系x,y轴,坐标原点为透镜光心,透镜焦距为f;

T

(2)设车载CMOS图像传感器中心在世界坐标系下的坐标为Ns=(Xs,Ys,Zs) ,其中Xs,Ys为待求的车载CMOS图像传感器的位置坐标,Zs为已知的车载CMOS图像传感器的高度;设第k个T光源LED在世界坐标系下的位置坐标为Pwk=(Xwk,Ywk,Zwk) ,该光源LED的成像点在图像坐标T T系下的坐标为pk=(xk,yk) ,该光源LED在相机坐标系下的坐标为Pck=(Xck,Yck,Zck) ,根据T该光源求出的自动驾驶车辆位置信息为Nsk=(Xsk,Ysk,Zsk) ,其中Zsk=Zs;Pwk,Pck和Nsk三者之间的坐标转换关系为:Pwk=RPck+Nsk (4‑1)

即:

其中,R为相机旋转矩阵:

其中,ω,φ,θ分别表示相机坐标系相对于世界坐标系X轴,Y轴,Z轴方向的偏角;

根据公式(4‑6)求出由第k个光源LED获得的CMOS图像传感器中心在世界坐标系下的坐T标Nsk=(Xsk,Ysk,Zs) ;

(3)判断图像内有效LED光斑数量是否为1,若为1,即k=1,直接根据公式(4‑6)计算得T T到CMOS图像传感器中心在世界坐标系下的坐标Ns=(Xs,Ys,Zs)=(Xs1,Ys1,Zs) ;否则执行步骤(4);

(4)设图像内有效LED光斑数量为n,根据公式(4‑8)计算车载CMOS图像传感器中心在世T界坐标系下的坐标Ns=(Xs,Ys,Zs) :

其中, 为像素坐标加权因子。

2.根据权利要求1所述的基于OCC的自动驾驶车辆跟踪定位方法,其特征在于所述的步骤3)中,对检测出的LED光斑进行跟踪解码的方法如下:(1)对接收到的图像进行阈值判决得到二值化图像,对处理后的图像每个LED光斑区域使用独立的线程实现曼彻斯特解码,解码后输出各光源LED在世界坐标系中的位置坐标信息的比特序列;

(2)利用光源LED的高速明暗变化特性,通过帧差法对连续的图像帧序列进行差值的计算,将LED光斑从背景图像中区分出来,实现对图像内多个LED光斑的跟踪;

(3)判断3帧内是否已经从检测到的LED光斑中成功解码出各光源LED的坐标信息,若未从检测到的LED光斑中成功解码出光源LED的坐标信息则判定为跟踪失效,将该LED光斑移除;若当前帧内所有检测到的LED光斑均跟踪失效,移除该帧图像,返回步骤2);

若至少一个LED光斑信息被成功解码则判定跟踪结束,缓存已解码的光源LED位置坐标信息,进入步骤4)。