基于椭圆拟合的环岛识别方法

TsinghuaJoking 2020-10-28 00:00

环岛元素是智能车比赛中较难处理的元素之一。比赛要求智能车能检测到环岛并从入口驶入,在绕行约 270°后驶出环岛,其中,能否高响应、高鲁棒性地检测环岛是后续进出环岛等步骤的基础。本文根据计算机视觉中的多视图几何学证明了环岛椭圆投影的存在,使用优化的最小二乘法拟合法并结合相关限制条件以识别环岛。

▲ 主板PCB

 

环岛元素是智能车比赛中较难处理的元素之一,由于车身在行驶过程中存在不确定性,故难以保证稳定识别效果。如图 1-1 与图 1-2 所示。

▲ 图 C-1 环岛灰度图
▲ 图 C-2 环岛二值化图

本文分析了传统电磁识别与摄像头识别环岛的优点和缺点,首先证明了环岛椭圆投影的正确性,然后此基础上提出了一种基于椭圆拟合的环岛识别方法,通过拉格朗日算子优化最小二乘误差函数使其最小化,并将结果转化为特征向量的形式。最后通过仿真和实验验证了此环岛识别方案的性能,并给出方案评价与可进一步研究的方向。

 

从信息获取的不同方式上来说,环岛检测方案可以分为摄像头识别和电磁识别。

2.1  电磁识别

智能车大赛道路中先布置了通有 20kHz、100mA 交变电流的中心电磁引导线,频率范围 20k±1kHz,电流范围 100±20mA。由于电磁引导线完全绕行与环岛,在环岛圆与赛道的交点处可等效为两倍电磁场,故可在智能车前支架配置

电感检测装置以检测智能车是否到达环岛入口处,即点 B 处。若电磁测量值约为正常行驶时的两倍,可置入环标志位。

▲ 图 C-3 环岛示意图

此方案的缺点在于滞后检测效应。当通过摄像头正常寻迹时,由于车身到入环点才能检测到环岛,车辆在 A、B 点之间时,由于左侧赛道缺失,智能车会往左侧偏移,随后因扫描到环岛内沿而校正回来,该过程使智能车震荡,导致行驶

到 B 点处位置可能发生偏移,导致电感检测失败。此外,对于摄像头为主要寻迹传感器的智能车,多加电磁传感器使系统更加冗余复杂。

2.2  摄像头识别

▲ 图 C-4 流程式环岛识别

一种常规的,利用摄像头进行环岛入口识别的方法如下。

(1) 右侧赛道突然变宽,左侧赛道正常,标志位置为 1。(2) 右侧赛道丢线,左侧赛道正常,标志位置为 2。(3) 右侧赛道由宽变窄,随后又逐渐变宽,左侧赛道不变,标志位置为 3。(4) 右侧赛道再次丢线,标志位置为 4。(5) 若标志位等于 4,则识别到环岛。

该方案计算量较小,但仍然存在滞后检测效应,智能车会在区间 2 处小幅度右转,影响后续过程的判断过程。除此之外,该方案为流程化方案,若在判断过程中有一个步骤意外出错都无法正确判断为环岛入口,导致智能车无法入环甚至冲出赛道。

 

对椭圆的投影进行建模,如下图所示。将P平明的圆投影到H平面。设P平面的椭圆长半轴长度为A,短半轴的长度为B。P平面与H平面的夹角为

取 $00  < \alpha  < 900$。于P平面建立笛卡尔坐标系XOY,椭圆长轴在X轴上,椭圆短轴在Y轴上,线段OO1的长度为L。可以平面P上的椭圆方程为:

▲ 图 C-5 椭圆映射图

一束平行光以 的方向照烧,是P平面椭圆映射在H平面上,形成椭圆o1。

在平面H上建立笛卡尔坐标系,oy与OY相重合,OX投影于ox,椭圆上一点M(X,Y)投影到m(x,y),可知两平面的坐标系关系为:

联立C-1与C-2,得:


将C-3记作:

显然,C-4为椭圆方程,即平面P上的椭圆经过平行光投影后仍然是椭圆。

特殊的,当平面P上的椭圆为圆时,有: ,则C-3为:

,平面H上的投影为:

$${{x 2 } \over {m'2 }} + {{y 2 } \over {n'2 }} = 1 $$

显然,当 时, ,该解析式描述的为椭圆。

对于环岛元素,设内环岛边缘为平面P上的圆。自然光线在P平面上的发生反射。由于物象距离较远,反射光可近似为平行光。根据摄像机的真空成像模型,反射光在详平面成像,即图像平面为H平面。因此,只需验证内环岛边缘微椭圆即可。

▲ C 车模电机驱动PCB

 

设椭圆一般方程为:

$$F\left( {a,x} \right) = a \cdot x = ax 2  + bxy + cy2  + dx + ey + f = 0 $$

其中,

对于一个待拟合的离散点集合, 表示点Xi到椭圆 的几何距离。

最小二乘法的目标是求取使得李散掉的几何距离最短的a,即最小化:

$$D_a  = \sum\limits_{i = 1} N {F\left( {a,X_i } \right)2 } $$

由于环岛内边缘投影为椭圆,而F(a,x)为广义圆锥曲线一般表达式,需要表示为添加约束条件,以保证你和结果仅为椭圆。即:

为了表达方便,将前面方程吧粗歘在:

其中:

故问题转换为最小化误差函数:

约束条件为:


其中矩阵:


对于一个离散点:

$$X_i  = \left[ {x 2 ,xy,y2 ,x,y,1} \right] $$

根据拉格朗日乘子法,求解 在条件 下的极值,构造Lagrange函数:

令:

求出x,y,lambda,可以得到:

,则有:

由于S为实对称矩阵,C为正定矩阵,故求解是为求解广义特征值问题。C正定,用 做成上式,可以得到:

则:

所以只需要求解上式的特征向量a即可。根据数值分析幂法可求。

 

根据椭圆一般方程:

$$F\left( {a,x} \right) = a \cdot x = ax 2  + bxy + cy2  + dx + ey + f = 0 $$

可的长半轴长度平方:

其中椭圆几何中心:

$$X_c  = {{be - 2cd} \over {4ac - b 2 }},\space \space \space Y_c  = {{bd - 2ae} \over {4ac - b2 }} $$

根据世纪环岛的映射特点,限定如下识别条件:(1)环岛映射非长扁椭圆,约束为 。(2)椭圆几何中心在左上侧,或者右上侧,约束为 ,H为图像高度;(3)以右环岛为例,为保证提前识别,约束为右下侧出现环岛尖角。

 

以图C-2为计算示例,取内环岛边缘点获取坐标。

使用MATLAB 仿真得到椭圆方程为:

$$F\left( {a,x} \right) = 0.00154x 2  - 0.019x \cdot y - 0.156x
+ 0.195 \cdot y
2  - 3.390y + 38.870 $$

椭圆参数为:

 

本文提出了一种基于椭圆拟合的环岛识别方法,相比于传统的摄像头识别与电感识别方法,该方法有以下特点。

(1) 无需流程式判断,降低整体误判断概率。

(2) 具有远前瞻特性,以免智能车因丢线而误转向。

(3) 利用最小二乘的结果代替了程序迭代过程,提高了运算速度。

通过实验分析研究表明,本文的方案有较快的运算速度、较强的棒性,不过仍有许多需要改进的地方,可在本文的基础上进行以下深入研究。

(1) 寻找更好的求解特征向量方法,进一步加快整体运算速度。

(2) 由于摄像机像素较小,对于较小的椭圆难以正确拟合与判断,可使用更高素质的摄像机。

(3) 由于车身位置变化,导致稳定寻找内环岛边缘区位置有一定困难,需要寻找更好的搜索方法。

▲ 车模电机驱动PCB

 

[1] 彭慧敏. 平面斜截正圆锥截交线为椭圆时投影曲线分析. 西安建筑科技大学学报: 自然科学版, 1998. 30(2): 第189-191页.

[2] 莫章金.  椭圆的投影及其应用.  重庆建筑高等专科学校学报, 1999. 9(2):  第28-31页.

[3] Fitzgibbon, A., M. Pilu and R.B. Fisher, Direct least square fitting of ellipses. IEEE Transactions on pattern analysis and machine intelligence, 1999. 21(5): p. 476-480.

[4] Hal?r, R. and J. Flusser. Numerically stable direct least squares fitting of ellipses. 1998: Citeseer.

[5] 李成章, 黄玉民.  数学分析.  上北京:  科学出版, 1999.

[6] Trefethen, L.N. and D. Bau III, Numerical linear algebra. Vol. 50. 1997: Siam.

[7] 封建湖. 数值分析原理. 2001:  科学出版社.




编者注:智能车竞赛所提出的任务不仅仅是赛场上那短暂的比赛过程,更多是通过设定特定的工程问题,激发同学将课内的理论知识付诸于实践,并实施不断探索追求的过程。

本文来自于中国地质大学参赛队伍技术报告中研究论文显示了参赛同学在这方面的努力。

TsinghuaJoking 这是一个公众号,它不端、不装,与你同游在课下、课上。 卓晴博士,清华大学中央主楼 626A。010-62773349, 13501115467,zhuoqing@tsinghua.edu.cn
评论
  • 当前,智能汽车产业迎来重大变局,随着人工智能、5G、大数据等新一代信息技术的迅猛发展,智能网联汽车正呈现强劲发展势头。11月26日,在2024紫光展锐全球合作伙伴大会汽车电子生态论坛上,紫光展锐与上汽海外出行联合发布搭载紫光展锐A7870的上汽海外MG量产车型,并发布A7710系列UWB数字钥匙解决方案平台,可应用于数字钥匙、活体检测、脚踢雷达、自动泊车等多种智能汽车场景。 联合发布量产车型,推动汽车智能化出海紫光展锐与上汽海外出行达成战略合作,联合发布搭载紫光展锐A7870的量产车型
    紫光展锐 2024-12-03 11:38 121浏览
  • 遇到部分串口工具不支持1500000波特率,这时候就需要进行修改,本文以触觉智能RK3562开发板修改系统波特率为115200为例,介绍瑞芯微方案主板Linux修改系统串口波特率教程。温馨提示:瑞芯微方案主板/开发板串口波特率只支持115200或1500000。修改Loader打印波特率查看对应芯片的MINIALL.ini确定要修改的bin文件#查看对应芯片的MINIALL.ini cat rkbin/RKBOOT/RK3562MINIALL.ini修改uart baudrate参数修改以下目
    Industio_触觉智能 2024-12-03 11:28 104浏览
  • 戴上XR眼镜去“追龙”是种什么体验?2024年11月30日,由上海自然博物馆(上海科技馆分馆)与三湘印象联合出品、三湘印象旗下观印象艺术发展有限公司(下简称“观印象”)承制的《又见恐龙》XR嘉年华在上海自然博物馆重磅开幕。该体验项目将于12月1日正式对公众开放,持续至2025年3月30日。双向奔赴,恐龙IP撞上元宇宙不久前,上海市经济和信息化委员会等部门联合印发了《上海市超高清视听产业发展行动方案》,特别提到“支持博物馆、主题乐园等场所推动超高清视听技术应用,丰富线下文旅消费体验”。作为上海自然
    电子与消费 2024-11-30 22:03 103浏览
  • RDDI-DAP错误通常与调试接口相关,特别是在使用CMSIS-DAP协议进行嵌入式系统开发时。以下是一些可能的原因和解决方法: 1. 硬件连接问题:     检查调试器(如ST-Link)与目标板之间的连接是否牢固。     确保所有必要的引脚都已正确连接,没有松动或短路。 2. 电源问题:     确保目标板和调试器都有足够的电源供应。     检查电源电压是否符合目标板的规格要求。 3. 固件问题: &n
    丙丁先生 2024-12-01 17:37 111浏览
  • 光伏逆变器是一种高效的能量转换设备,它能够将光伏太阳能板(PV)产生的不稳定的直流电压转换成与市电频率同步的交流电。这种转换后的电能不仅可以回馈至商用输电网络,还能供独立电网系统使用。光伏逆变器在商业光伏储能电站和家庭独立储能系统等应用领域中得到了广泛的应用。光耦合器,以其高速信号传输、出色的共模抑制比以及单向信号传输和光电隔离的特性,在光伏逆变器中扮演着至关重要的角色。它确保了系统的安全隔离、干扰的有效隔离以及通信信号的精准传输。光耦合器的使用不仅提高了系统的稳定性和安全性,而且由于其低功耗的
    晶台光耦 2024-12-02 10:40 134浏览
  •         温度传感器的精度受哪些因素影响,要先看所用的温度传感器输出哪种信号,不同信号输出的温度传感器影响精度的因素也不同。        现在常用的温度传感器输出信号有以下几种:电阻信号、电流信号、电压信号、数字信号等。以输出电阻信号的温度传感器为例,还细分为正温度系数温度传感器和负温度系数温度传感器,常用的铂电阻PT100/1000温度传感器就是正温度系数,就是说随着温度的升高,输出的电阻值会增大。对于输出
    锦正茂科技 2024-12-03 11:50 135浏览
  • 作为优秀工程师的你,已身经百战、阅板无数!请先醒醒,新的项目来了,这是一个既要、又要、还要的产品需求,ARM核心板中一个处理器怎么能实现这么丰富的外围接口?踌躇之际,你偶阅此文。于是,“潘多拉”的魔盒打开了!没错,USB资源就是你打开新世界得钥匙,它能做哪些扩展呢?1.1  USB扩网口通用ARM处理器大多带两路网口,如果项目中有多路网路接口的需求,一般会选择在主板外部加交换机/路由器。当然,出于成本考虑,也可以将Switch芯片集成到ARM核心板或底板上,如KSZ9897、
    万象奥科 2024-12-03 10:24 86浏览
  • 最近几年,新能源汽车愈发受到消费者的青睐,其销量也是一路走高。据中汽协公布的数据显示,2024年10月,新能源汽车产销分别完成146.3万辆和143万辆,同比分别增长48%和49.6%。而结合各家新能源车企所公布的销量数据来看,比亚迪再度夺得了销冠宝座,其10月新能源汽车销量达到了502657辆,同比增长66.53%。众所周知,比亚迪是新能源汽车领域的重要参与者,其一举一动向来为外界所关注。日前,比亚迪汽车旗下品牌方程豹汽车推出了新车方程豹豹8,该款车型一上市就迅速吸引了消费者的目光,成为SUV
    刘旷 2024-12-02 09:32 131浏览
  • 学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习笔记&记录学习习笔记&记学习学习笔记&记录学习学习笔记&记录学习习笔记&记录学习学习笔记&记录学习学习笔记记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&
    youyeye 2024-11-30 14:30 85浏览
  • 概述 说明(三)探讨的是比较器一般带有滞回(Hysteresis)功能,为了解决输入信号转换速率不够的问题。前文还提到,即便使能滞回(Hysteresis)功能,还是无法解决SiPM读出测试系统需要解决的问题。本文在说明(三)的基础上,继续探讨为SiPM读出测试系统寻求合适的模拟脉冲检出方案。前四代SiPM使用的高速比较器指标缺陷 由于前端模拟信号属于典型的指数脉冲,所以下降沿转换速率(Slew Rate)过慢,导致比较器检出出现不必要的问题。尽管比较器可以使能滞回(Hysteresis)模块功
    coyoo 2024-12-03 12:20 153浏览
  • TOF多区传感器: ND06   ND06是一款微型多区高集成度ToF测距传感器,其支持24个区域(6 x 4)同步测距,测距范围远达5m,具有测距范围广、精度高、测距稳定等特点。适用于投影仪的无感自动对焦和梯形校正、AIoT、手势识别、智能面板和智能灯具等多种场景。                 如果用ND06进行手势识别,只需要经过三个步骤: 第一步&
    esad0 2024-12-04 11:20 88浏览
  • 《高速PCB设计经验规则应用实践》+PCB绘制学习与验证读书首先看目录,我感兴趣的是这一节;作者在书中列举了一条经典规则,然后进行详细分析,通过公式推导图表列举说明了传统的这一规则是受到电容加工特点影响的,在使用了MLCC陶瓷电容后这一条规则已经不再实用了。图书还列举了高速PCB设计需要的专业工具和仿真软件,当然由于篇幅所限,只是介绍了一点点设计步骤;我最感兴趣的部分还是元件布局的经验规则,在这里列举如下:在这里,演示一下,我根据书本知识进行电机驱动的布局:这也算知行合一吧。对于布局书中有一句:
    wuyu2009 2024-11-30 20:30 141浏览
  • 11-29学习笔记11-29学习笔记习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习笔记&记录学习习笔记&记学习学习笔记&记录学习学习笔记&记录学习习笔记&记录学习学习笔记&记录学习学习笔记记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&记录学习学习笔记&学习学习笔记&记录学习学习笔记&记录学习学习笔记&记
    youyeye 2024-12-02 23:58 88浏览
我要评论
0
点击右上角,分享到朋友圈 我知道啦
请使用浏览器分享功能 我知道啦