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

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
评论
  • 嘿,咱来聊聊RISC-V MCU技术哈。 这RISC-V MCU技术呢,简单来说就是基于一个叫RISC-V的指令集架构做出的微控制器技术。RISC-V这个啊,2010年的时候,是加州大学伯克利分校的研究团队弄出来的,目的就是想搞个新的、开放的指令集架构,能跟上现代计算的需要。到了2015年,专门成立了个RISC-V基金会,让这个架构更标准,也更好地推广开了。这几年啊,这个RISC-V的生态系统发展得可快了,好多公司和机构都加入了RISC-V International,还推出了不少RISC-V
    丙丁先生 2025-01-21 12:10 730浏览
  •  万万没想到!科幻电影中的人形机器人,正在一步步走进我们人类的日常生活中来了。1月17日,乐聚将第100台全尺寸人形机器人交付北汽越野车,再次吹响了人形机器人疯狂进厂打工的号角。无独有尔,银河通用机器人作为一家成立不到两年时间的创业公司,在短短一年多时间内推出革命性的第一代产品Galbot G1,这是一款轮式、双臂、身体可折叠的人形机器人,得到了美团战投、经纬创投、IDG资本等众多投资方的认可。作为一家成立仅仅只有两年多时间的企业,智元机器人也把机器人从梦想带进了现实。2024年8月1
    刘旷 2025-01-21 11:15 722浏览
  •     IPC-2581是基于ODB++标准、结合PCB行业特点而指定的PCB加工文件规范。    IPC-2581旨在替代CAM350格式,成为PCB加工行业的新的工业规范。    有一些免费软件,可以查看(不可修改)IPC-2581数据文件。这些软件典型用途是工艺校核。    1. Vu2581        出品:Downstream     
    电子知识打边炉 2025-01-22 11:12 148浏览
  • 临近春节,各方社交及应酬也变得多起来了,甚至一月份就排满了各式约见。有的是关系好的专业朋友的周末“恳谈会”,基本是关于2025年经济预判的话题,以及如何稳定工作等话题;但更多的预约是来自几个客户老板及副总裁们的见面,他们为今年的经济预判与企业发展焦虑而来。在聊天过程中,我发现今年的聊天有个很有意思的“点”,挺多人尤其关心我到底是怎么成长成现在的多领域风格的,还能掌握一些经济趋势的分析能力,到底学过哪些专业、在企业管过哪些具体事情?单单就这个一个月内,我就重复了数次“为什么”,再辅以我上次写的:《
    牛言喵语 2025-01-22 17:10 199浏览
  • 数字隔离芯片是一种实现电气隔离功能的集成电路,在工业自动化、汽车电子、光伏储能与电力通信等领域的电气系统中发挥着至关重要的作用。其不仅可令高、低压系统之间相互独立,提高低压系统的抗干扰能力,同时还可确保高、低压系统之间的安全交互,使系统稳定工作,并避免操作者遭受来自高压系统的电击伤害。典型数字隔离芯片的简化原理图值得一提的是,数字隔离芯片历经多年发展,其应用范围已十分广泛,凡涉及到在高、低压系统之间进行信号传输的场景中基本都需要应用到此种芯片。那么,电气工程师在进行电路设计时到底该如何评估选择一
    华普微HOPERF 2025-01-20 16:50 130浏览
  • 2024年是很平淡的一年,能保住饭碗就是万幸了,公司业绩不好,跳槽又不敢跳,还有一个原因就是老板对我们这些员工还是很好的,碍于人情也不能在公司困难时去雪上加霜。在工作其间遇到的大问题没有,小问题还是有不少,这里就举一两个来说一下。第一个就是,先看下下面的这个封装,你能猜出它的引脚间距是多少吗?这种排线座比较常规的是0.6mm间距(即排线是0.3mm间距)的,而这个规格也是我们用得最多的,所以我们按惯性思维来看的话,就会认为这个座子就是0.6mm间距的,这样往往就不会去细看规格书了,所以这次的运气
    wuliangu 2025-01-21 00:15 369浏览
  • 现在为止,我们已经完成了Purple Pi OH主板的串口调试和部分配件的连接,接下来,让我们趁热打铁,完成剩余配件的连接!注:配件连接前请断开主板所有供电,避免敏感电路损坏!1.1 耳机接口主板有一路OTMP 标准四节耳机座J6,具备进行音频输出及录音功能,接入耳机后声音将优先从耳机输出,如下图所示:1.21.2 相机接口MIPI CSI 接口如上图所示,支持OV5648 和OV8858 摄像头模组。接入摄像头模组后,使用系统相机软件打开相机拍照和录像,如下图所示:1.3 以太网接口主板有一路
    Industio_触觉智能 2025-01-20 11:04 199浏览
  • 高速先生成员--黄刚这不马上就要过年了嘛,高速先生就不打算给大家上难度了,整一篇简单但很实用的文章给大伙瞧瞧好了。相信这个标题一出来,尤其对于PCB设计工程师来说,心就立马凉了半截。他们辛辛苦苦进行PCB的过孔设计,高速先生居然说设计多大的过孔他们不关心!另外估计这时候就跳出很多“挑刺”的粉丝了哈,因为翻看很多以往的文章,高速先生都表达了过孔孔径对高速性能的影响是很大的哦!咋滴,今天居然说孔径不关心了?别,别急哈,听高速先生在这篇文章中娓娓道来。首先还是要对各位设计工程师的设计表示肯定,毕竟像我
    一博科技 2025-01-21 16:17 165浏览
  • 飞凌嵌入式基于瑞芯微RK3562系列处理器打造的FET3562J-C全国产核心板,是一款专为工业自动化及消费类电子设备设计的产品,凭借其强大的功能和灵活性,自上市以来得到了各行业客户的广泛关注。本文将详细介绍如何启动并测试RK3562J处理器的MCU,通过实际操作步骤,帮助各位工程师朋友更好地了解这款芯片。1、RK3562J处理器概述RK3562J处理器采用了4*Cortex-A53@1.8GHz+Cortex-M0@200MHz架构。其中,4个Cortex-A53核心作为主要核心,负责处理复杂
    飞凌嵌入式 2025-01-24 11:21 80浏览
  • 故障现象 一辆2007款日产天籁车,搭载VQ23发动机(气缸编号如图1所示,点火顺序为1-2-3-4-5-6),累计行驶里程约为21万km。车主反映,该车起步加速时偶尔抖动,且行驶中加速无力。 图1 VQ23发动机的气缸编号 故障诊断接车后试车,发动机怠速运转平稳,但只要换挡起步,稍微踩下一点加速踏板,就能感觉到车身明显抖动。用故障检测仪检测,发动机控制模块(ECM)无故障代码存储,且无失火数据流。用虹科Pico汽车示波器测量气缸1点火信号(COP点火信号)和曲轴位置传感器信
    虹科Pico汽车示波器 2025-01-23 10:46 92浏览
我要评论
0
点击右上角,分享到朋友圈 我知道啦
请使用浏览器分享功能 我知道啦