利用光线跟踪加速欧几里德符号距离场的地图构建.pdf

第 卷第期陕西科技大学学报V o l N o 年月J o u r n a l o fS h a a n x iU n i v e r s i t yo fS c i e n c e&T e c h n o l o g y A u g 文章编号:X()利用光线跟踪加速欧几里德符号距离场的地图构建唐嘉宁,刘志聪,李孟霜,彭志祥,谢翠娟,陈云浩,(云南民族大学 电气信息工程学院,云南 昆明 ;云南民族大学 无人自主系统研究院,云南 昆明 )摘要:针对现有小型无人飞行器在复杂未知环境中执行自主探索任务时,存在机载端G P U计算资源不足,在线建图速度慢、探索效率低的问题本文在传统欧几里德符 号距离场(E S D F)方法的基础上,融合光线跟踪原理,加速构建E S D F地图,以提高飞行器在复杂未知环境中的探索效率首先使用整数运算提高光线跟踪遍历体素的速度,从而加速体素占用概率的更新;然后通过调整哈希数据结构,减少地图占用内存;最后使用广度优先搜索算法(B F S)实现地图更新与融合为验证本文方法的有效性,分别在公开数据集、仿真环境和真实环境下,与当前前沿的建图方法进行对比,实验结果表明,本文所提出的方法在三种不同情况下的地图平均更新时间分别减少了 、和 ,显著提高了建图速度,为小型无人飞行器在线探索奠定基础关键词:地图构建;光线跟踪;符号距离场;梯度优化中图分类号:V 文献标志码:AA c c e l e r a t i n ge u c l i d e a ns i g n e dd i s t a n c e f i e l dm a p p i n gb yr a y t r a c i n gT ANGJ i a n i n g,L I UZ h i c o n g,L IM e n g s h u a n g,P E NGZ h i x i a n g,X I EC u i j u a n,CHE NY u n h a o,(S c h o o l o fE l e c t r i c a l a n dI n f o r m a t i o nT e c h n o l o g y,Y u n n a nM i n z uU n i v e r s i t y,K u n m i n g ,C h i n a;I n s t i t u t eo fU n m a n n e dA u t o n o m o u sS y s t e m,Y u n n a nM i n z uU n i v e r s i t y,K u n m i n g ,C h i n a)A b s t r a c t:F o rt h ee x i s t i n gs m a l lu n m a n n e da e r i a lv e h i c l e s(UAV s)p e r f o r m i n ga u t o n o m o u se x p l o r a t i o nt a s k s i nc o m p l e xa n du n k n o w ne n v i r o n m e n t s,t h e r ea r ep r o b l e m ss u c ha s i n s u f f i c i e n t c o m p u t i n gr e s o u r c e so f t h ea i r b o r n eG P U,s l o wo n l i n em a p p i n ga n d l o we x p l o r a t i o ne f f i c i e n c y B a s e do nt h e t r a d i t i o n a lE u c l i d e a ns i g n e dd i s t a n c ef i e l d(E S D F)m e t h o d,t h i sp a p e ri n t e g r a t e s t h er a y t r a c i n gp r i n c i p l e a n da c c e l e r a t e s t h e c o n s t r u c t i o no fE S D Fm a p s t o i m p r o v et h ee x p l o r a t i o ne f f i c i e n c yo fa i r c r a f t i nc o m p l e xa n du n k n o w ne n v i r o n m e n t s F i r s t l y,i n t e g e ro p e r a t i o ni su s e d t o i m p r o v e t h e s p e e do f r a y t r a c i n gv o x e l t r a v e r s a l,t h u s s p e e d i n gu p t h eu p d a t eo fv o x e l o c c u p a n c yp r o b a b i l i t y;T h e na d j u s t t h eh a s hd a t as t r u c t u r e t or e d u c e t h em e m 收稿日期:基金项目:国家自然科学基金项目()作者简介:唐嘉宁(),女,云南昆明人,教授,博士,研究方向:多无人机协同、S L AM定位建图通讯作者:陈云浩(),男,山东济南人,讲师,博士,研究方向:视觉S L AM、路径规划,c y h_ c o m第期唐嘉宁等:利用光线跟踪加速欧几里德符号距离场的地图构建o r yo c c u p i e db yt h em a p;F i n a l l y,t h eb r e a d t hf i r s t s e a r c ha l g o r i t h m(B F S)i su s e dt ou p d a t ea n df u s e t h em a p I no r d e r t ov e r i f yt h ee f f e c t i v e n e s so f t h em e t h o dp r o p o s e d i nt h i sp a p e r,i ti sc o m p a r e dw i t ht h ec u r r e n tc u t t i n g e d g em a p p i n gm e t h o d s i nt h eo p e nd a t a s e t,s i m u l a t i o ne n v i r o n m e n t a n dr e a l e n v i r o n m e n t r e s p e c t i v e l y T h ee x p e r i m e n t a l r e s u l t s s h o wt h a t t h ea v e r a g em a pu p d a t e t i m eo f t h em e t h o dp r o p o s e d i nt h i sp a p e r i nt h r e ed i f f e r e n ts i t u a t i o n s i sr e d u c e db y ,a n d r e s p e c t i v e l y,w h i c hs i g n i f i c a n t l yi m p r o v e st h em a p p i n gs p e e da n d l a y sa f o u n d a t i o nf o ro n l i n ee x p l o r a t i o no f s m a l lu n m a n n e da e r i a l v e h i c l e s K e yw o r d s:m a p p i n g;r a yt r a c i n g;s i g n e dd i s t a n c e f i e l d s;g r a d i e n to p t i m i z a t i o n引言小型无人飞行器因其体积小和灵活性,已经成为最广泛的无人自主系统研究平台之一,并且多应用于未知环境的自主探索及自主导航等方面 由于小型飞行器自身的低载荷及有限的机载计算能力,使小型飞行器在进行自主探索的过程中需要快速、轻量级的算法进行环境感知、地图构建和航迹规划地图是无人机进行导航的基础,无人机航迹规划过程中有很多不同类型的地图框架可以使用其中,占用栅格地图是规划算法中常用的地图形式之一,它可以用于快速碰撞检测以及占用概率的评估,O c t o m a p基于八叉树的数据结构,用来表示紧凑的内存,进行地图查询和存储占用概率 C h e n等利用八叉树的数据结构,将空闲空间进行划分,生成安全飞行走廊,用以生成无碰撞的安全轨迹 J i等提出了一个m a p l e s s p l a n n e r系统,它利用原始的点云地图进行规划,通过最近邻查询算法,查找空间中最近的障碍物,以此生成球形飞行走廊而保证高质量的轨迹 F l o r e n c e等提出一种新的地图结构,它能够在规划时有效查询地图构建时位姿不确定性的局部 D几何信息,从而实现提高规划的效率以及鲁棒性,支持无人机安全快速飞行的目的但是对于无人机自主导航来说,轨迹规划需要的是空闲空间的信息,而不是障碍物的信息,用于轨迹规划的理想地图要求能够快速查询地图中每个体素的空闲、占用状态,或者能够方便的获取当前体素到障碍物的距离,例如欧几里德符号 距 离 场(E S D F,E u c l i d e a n S i g n e d D i s t a n c eF i e l d)地图 E S D F地图中的每个体素都储存着当前体素距离其最近障碍物的直线距离和梯度信息,因此广泛的应用于基于梯度的无人自主导航规划 基于梯度信息的轨迹规划方法能够将生成的轨迹推离障碍物,以保证轨迹的安全性 Z h o u等 中利用局部E S D F地图中的梯度信息和动态约束,通过B样条来优化初始路径,保证路径的安全性和动态可行性,以此用于三维复杂环境中的快速飞行最近,众多机构在增量构建三维规划的E S D F地图方面做了大量工作 O l e y n i k o v a等 提出的V o x b l o x框架,专注于从截断符号距离场(T S D F,T r u n c a t e dS i g n e dD i s t a n c eF i e l d s)增量构建E S D F地图该框架首先将传感器数据集成到T S D F地图,它包含曲面截断半径内地距离信息,然后使用广度优先搜索算法从T S D F增量计算E S D F与之相似的是H a n等 提出的F i e s t a框架,该方法以增量方式从占用栅格地图构建全局E S D F地图,通过引入两个独立更新队列分别插入和删除障碍,并使用索引数据结构和双链表对地图进行维护更新C h e n等 提出了一种基于G P U的地图构建系统,该系统在G P U上并行构建占用栅格地图和E S D F,利用并行的线程同时处理删除和插入障碍物操作满足小型无人飞行器在未知环境进行在线探索的主要挑战是以高效和准确的方式维护E S D F地图更新,虽然有不同的方法能动态构建E S D F地图,但是只有少数方法可以在仅有C P U平台式运行针对机载端计算资源不足,导致在线建图速度慢、探索效率低的问题本文在传统欧几里德符号距离场(E S D F)方法的基础上,融合光线跟踪原理,加速构建E S D F地图,在仅有C P U的计算资源下保证小型无人飞行器在复杂未知环境中的探索效率首先使用整数运算提高光线跟踪遍历体素的速度,从而加速体素占用概率的更新;然后通过调整哈希数据结构,减少地图占用内存;最后使用广度优先搜索算法(B F S)实现地图更新与融合通过数据集、仿真环境以及真实环境的测试实验,验证了该算 法的可行性及 适用性本 文的主要贡 献如下:()提出了一种利用光线跟踪快速体素遍历的方法陕西科技大学学报第 卷()将快速体素遍历算法集成到小型无人机平台,提出了一种能够在C P U平台上快速构建E S D F地图的框架系统框架构建E S D F地图的系统框架如图所示,虚线部分为本文的工作范围在地图构建过程中,系统首先从传感器中获取环境数据,其中深度图像信息可以通过单目深度估计或者机载传感器(如R G B D深度相机、激光雷达)获得位姿信息可以从外部设备G P S或者V i c o n动作捕捉系统获得,也可以从内部位姿估计如V I O(视觉惯性里程计)获得然后使用改进的光线跟踪方法将这些数据加速集成到占用栅格地图中,将占用栅格地图作为储存占用信息的数据结构通过使用体素哈希方法来处理持续增长的地图,最后用B F S算法将新的地图数据融合到现有地图,实现地图快速更新图地图构建系统框架图基于光线跟踪快速体素遍历方法当前有两种主流的方法构建E S D F地图,一种是从T S D F表示的基础上逐步构建E S D F地图如v o x b l o x;另一种是从 占用栅格地 图中增量 构建E S D F地图,对于占用栅格地图,需将环境信息映射到一组由空闲或者占用状态表示的体素中,如F i e s t a 其中v o x b l o x基于T S D F采用的是投影距离,即沿传感器射线到测量表面的距离,容易高估到最近表面的实际欧几里德距离,而F i e s t a使用占据栅格图,计算的是传感器到体素中心的真实欧几里德距离,地图构建精度更高因此本文专注直接从占用栅格地图构建E S D F地图,其构建的步骤如下:()通过传感器观测获取深度点云信息()传感器原点和点云中的每个点构成一条具有固定长度的单独光线()对于所有光线,使用光线跟踪遍历体素,用以发现空闲和占用的体素()将观测到的体素合并到占用栅格图中,并根据体素概率进行地图更新其中,在每次光线跟踪处理中,上述步骤、占其处理时间 以上针对该问题本文将利用加速体素遍历来缩短其光线跟踪的处理时间占用栅格地图通常将三维空间均匀分割为大小相等的正方体遍历三维空间中的体素,其中每个正方体即为一个体素在三维空间中,一个体素与相邻的六个体素都有一个公共面,这种连接方式称为连接与之相似的是 连接,因为每个体素包含 个邻居(个面连接,个边连接和个顶点连接)光线跟踪的目的是为了遍历这些体素并且确定这些体素哪些是占用哪些是空闲地图构建过程示意图如图所示,当相机发射一条光线,能穿过的中间体素标记为空闲(图中米黄色格),穿不过的即为占用(图中黑色格)当进行体素遍历时,找到每条光线所在直线经过的体素,后续只需要对这些体素所包含的对象与直线进行求交点操作从而进行体素遍历图地图构建过程示意图对于体素遍历算法,首先考虑二维情况,为了正确遍历网格,算法必须按照如图所示的顺序(a,b,c,d,e,f,j)访问体素,光线方程为:Pptv()式()中:v光线方向,p和p分别为光线的起点和终点,t为遍历一个体素的时间间隔图二维体素遍历顺序遍历算法包括两个阶段:初始化和增量遍历初始化阶段从光线原点开始,如果光线原点在网格之外,则找到光线进入网格的交点,并获取相邻的体素二维体素遍历如图所示第期唐嘉宁等:利用光线跟踪加速欧几里德符号距离场的地图构建图二维体素遍历直线的起点和终点分别为(x,y)和(x,y),令:dxxxdyyy()整数变量(X,Y)初始化为体素原点坐标,步长s e tX和s e tY初始化为或者当步长为时,体素坐标(X,Y)进行递增,而步长为时,体素坐(X,Y)标进行递减从起点开始沿着光线方向分别计算v水平方向和竖直方向穿过第一个体素边界的t值,分别记为t X和t Y,为了方便假设体素的边长为,由式()和式()可得:t X(x)/dxt Y(y)/dy()为了不产生累计误差,并且提高计算速度,上式还需整数化,对式()上下同乘dxdy,则有:tI n tX(x)dytI n tY(y)dx()然后再分别计算水平方向和竖直方向光线移动的距离(以t为单位)使其值等于体素的宽度值,分别记为t X和 t Y,则有:t X s e tX/dxt Y s e tY/dy()算法的增量遍历阶段,当tI n tXtI n tY即说明光线先从当前体素穿过其右邻体素,此时体素坐标从(X,Y)增加到(X,Y);反之当tI n tXtI n tY即光线先从当前体素穿过其邻上体素,此时体素坐标从(X,Y)增加到(X,Y)体素遍历算法如下:二维体素遍历算法:w h i l e(t r u e):i f(tI n tXtI n tY):xxs e tX:tI n tXtI n tXt X:e l s e:yys e tY:tI n tYtI n tYt Y:e n d i f:i f(d i s tm a x D i s t)r e t u r n:e n dw h i l e在循环过程中,加入距离限制,d i s t为当前体素到光线原点的欧式距离,当这个距离大于m a x D i s t(起点与终点的距离)时,跳出循环从二维算法扩展到三维只需要适当添加Z分量即t I n t Z,t Z的值即可E S D F地图构建方法 占用栅格地图本文通过占用栅格地图构建E S D F地图,占用栅格地图来存储体素的占用概率,当从传感器获取到新的深度信息时,占用栅格地图不断更新从光线跟踪获得的新的占用信息数据,对于每个体素,用p(s)表示为其空闲状态的概率,p(s)表示为其占用状态的概率则两者的比值可以表示为该体素的状态O d d(s)p(s)p(s)()当一个体素被重复观测时,需要对它的状态进行更新,对于前一刻状态为O d d(s),新的观测值为Z(取值为,),则状态更新为:O d d(s|z)p(s|z)p(s|z)()令l o m e a s l o gp(s|z)p(s|z)()结合公式()化简公式()并取对数可得:SSl o m e a s()式()中:S和S表示体素更新前后的状态 地图数据结构对于构建三维栅格地图如果内存够大且已知地图尺寸和分辨率大小,通常利用数组直接进行索引工作但是在自主探索过程中,无人机要探索的区域往往是未知的,通常采用哈希表来进行体素索引工作,以减小内存消耗但是单纯使用哈希表进行体素索引,由于其所需查找索引的数量巨大,导致其性能比使用数组的方式差参考文献 利用哈希表和数组结合的方式索引一个体素坐标,通过生成一 个个体素 组成的体 素块,采用哈希表用于块管理从体坐标计算得到块坐标后,哈希表用于查找相应的块,该块中所有体素的索引储存在相对于块的数组中由于块哈希表的数量远少于体素哈希表的数量,因此哈希表用于块管理可以节省更多的内存,用于提高地图构建的性能陕西科技大学学报第 卷 地图更新E S D F地图中每个地图都存储着距离最近障碍物的欧几里德距离,即对于空闲空间中的点坐标p(x,y,z),确定到所有障碍物b(i,j,k)的最近距离为:m i n D i s t(x,y,z)(xi)(yj)(zk)()E S D F地图更新示意图如图所示,E S D F地图更新算法基于广度优先搜索算法在图(a)中,当o b s未插入时,体素V的最近障碍物为o b s,此时插入一个新的障碍物o b s,则从该障碍物点的邻居开始搜索,当这个邻居V与o b s的距离小于之前存储的最近距离(体素V与其最近障碍物o b s的距离),则将存储的距离信息更新为新的最近距离,并且把该邻居作为生长点,搜索其下一个邻居并进行比较如图(b)中,当删除一个障碍物时,即障碍物o b s删除,把该点的距离设为无穷大,查找所有以o b s为最近障碍物的体素若删除前V的最近障碍物为o b s,则查找V邻居的最近障碍物,用该邻居的最近障碍物作为体素V的最近障碍物例如,图(b)中V邻居中n b r的最近障碍物为o b s,即把o b s作为V的最近障碍物,以此来更新最近欧几里德距离m i nD i s t(x,y,z)图E S D F地图更新示意图实验结果与分析 实验设置为了验证所提算法的可行性与适用性,本文在机器人操作系统(R O S,R o b o tO p e r a t i n gS y s t e m)中进行实验,该系统包含了视觉图像模块与地图构建模块之间的通信,并采用R v i z作为实时地图构建的显示平台在同等测试条件下本文分别在公开R G B D数据集、仿真环境和真实场景中进行实验,并将提出的方法与先进的E S D F地图构建方法F i e s t a框架进行比较 该系统运行在配备U b u n t u 位操作系统,I n t e lC o r e i (核 GH z)和 G BR AM的笔记本电脑上运行实验所涉及到的基本仿真参数如表所示表基本仿真参数参数名称参数深度图像分辨率 E S D F地图分辨率 m相机采集频率 H z传感器视距范围m 实验结果 R G D B数据集分析本次实验采用的是苏黎世联邦理工学院自主系统实验室(A S L)的公开数据集c o w_a n d_l a d y,该数据集是一个具有地面实况的小型数据集,拍摄的是一个室内办公室环境,包含一头奶牛,一个人体模型和一些其他典型的办公配件数据集包含彩色R G B D点云数据和位姿信息 c o w_a n d_l a d y数据集实验的原始场景及两种方法实时构建的E S D F地图如图所示,地图更新时间对比如图所示,在同等条件测试下F i e s t a的方法平均地图更新时间为 m s,而本文的方法单次平均地图更新时间仅为 m s,本文地图构建速度比F i e s t a的方法快了倍左右图 c o w_a n d_l a d y数据集实验及构建的E S D F地图对比图第期唐嘉宁等:利用光线跟踪加速欧几里德符号距离场的地图构建 仿真环境实验本文采用R o t o r s仿真环境,其中包含一个搭载双目深度相机的六旋翼无人机仿真环境由G a z e b o构建,提供对外接口,能够通过R O S获取深度图像数据和无人机位姿信息本次实验利用该仿真环境,在G a z e b o构建尺寸为mmm的室内地图,通过键盘控制无人机飞行 R o t o r s仿真环境试实验环境及E S D F地图对比图如图所示,其中图(a)为仿真环境图,图(b)、(c)分别为本文算法实时构建的E S D F地图和F i e s t a构建的地图,地图更新时间对比如图所示在相同条件测试下F i e s t a的 方 法 单 次 平 均 地 图 更 新 时 间 为 m s,而本文的方法平均地图更新时间仅为 m s,本文地图构建速度比F i e s t a的方法快倍左右图R o t o r s仿真实验环境及E S D F地图对比图 真实环境场景实验对于真 实 场 景 实 验,实 验 采 用 英 特 尔R e a l S e n s ed i立体视觉深度相机,用以采集地图构建所需的深度图像,相机采集频率为 H z,深度测量范围m,所获深度图像分辨率为 ,并且通过v i n s_f u s i o n 框架进行视觉定位,用来获取相机的位姿本次实验的场地为一条尺寸为 mmm的走廊真实场景实验及构建的E S D F地图对比图如图所示,其中图(a)为真实环境如,图(b)、(c)分别为本文实时构建的E S D F地图和F i e s t a构建的地图地图更新时间对比如图所示,在同等条件测试下F i e s t a的方法平均地图更新时间为 m s,而本文的方法单次平均地图更新时间仅为 m s,本文地图构建速度比F i e s t a的方法快倍左右图真实场景实验及构建的E S D F地图对比图图为对三次不同场景、两种算法下E S D F地图平均更新时间的性能对比结果,图中簇状图为地图平均更新时间,折线图为本文所提算法与F i e s t a方法在相同环境下地图平均更新时间的降低比率从图可以看出,在数据集、仿真环境和真实场景中,本文所提出算法的平均地图更新时间分别比F i e s t a方法减少了 、和 多个场景的实验结果表明,本文所提出的算法可以显著降低实时构建E S D F地图的时间,具有一定的可行性和高效性陕西科技大学学报第 卷图三次实验时间性能对比为了验证真实环境场景下不同相机采样频率对建图精度的影响,进行了不同相机频率下的真实环境建图实验实验中,深度相机以m/s的速度匀速移动,采样频率分别设置为 H z、H z、H z、H z和 H z,平均地图更新时间控制在m s内通过在建图结果的长边和宽边分别随机选取个测量点,计算平均值后与实际尺寸对比以评估建图精度不同相机频率下,论文所提方法的地图构建精度对比结果如图 所示,其中,柱状图为不同相机采样频率下建图的长边长度,折线图为宽边的建图长度实验结果与实际场景尺寸对比可知,相机的采样频率与建图误差之间没有明显的对应关系,论文所提出建图方法在实际场景下的建图误差较小,m真实环境的建图误差小于 m,m真实环境的建图误差小于 m图 不同频率下地图精度对比对于本文方法构建的E S D F地图,本文还测量了在仿真环境及真实场景环境下地图的长宽距离来计算其建图精度仿真与真实场景分别进行了次实验,每次实验测量了地图的长宽距离来计算其建图精度,其中长宽的计算为每条边各取个测量点所测算的平均距离仿真环境与真实环境下地图精度误差对比图如图 所示从图中比对结果可以看出,不论在仿真环境或者真实场景下本文方法与传统F i e s t a方法在精度偏差分别能够控制在 m及 m以内,两个建图方法在精度上基本能保持一致从实验可以看出在保持地图分辨率相同时,本文方法在提高建图速度后对于建图的精度并没有明显降低为了满足无人机自主探索实时性的要求,对于当前构建E S D F地图的精度误差是可以接受的因为对于大部分自主规划算法来说,为了保证飞行过程中的安全性,都会适当的把障碍物进行膨胀处理而且E S D F地图又适用于基于梯度优化的方法,该方法能够利用障碍物的距离信息,把飞行轨迹推离障碍物,从而保证了飞行安全性第期唐嘉宁等:利用光线跟踪加速欧几里德符号距离场的地图构建图 仿真环境与真实环境地图误差对比结论针对机载端计算资源不足,导致在线建图速度慢、探索效率低的问题本文在传统欧几里德符号距离场方法的基础上,融合光线跟踪原理,加速构建E S D F地图,在仅有C P U的计算资源下保证小型无人飞行器在复杂未知环境中的探索效率首先使用整数运算提高光线跟踪遍历体素的速度,从而加速体素占用概率的更新;然后通过调整哈希数据结构,减少地图占用内存;最后使用广度优先搜索算法实现地图更新与融合通过数据集、仿真环境以及真实环境的测试实验,证实本文所提出算法的平均 地 图 更 新 时 间 分 别 比F i e s t a方 法 减 少 了 、和 ,通过精度对比实验也可以看出本文在减少地图构建时间后相较于传统F i e s t a方法还能不降低的地图构建精度,充分验证了算法的可行性与高效性参考文献X uZ,D e n gD,S h i m a d aK A u t o n o m o u sUAVe x p l o r a t i o no fd y n a m i ce n v i r o n m e n t sv i ai n c r e m e n t a ls a m p l i n ga n dp r o b a b i l i s t i c r o a d m a pJ I E E ER o b o t i c sa n dA u t o m a t i o nL e t t e r s,():K r t k yV,P e t r ce kP,B caT,e ta l A na u t o n o m o u su n m a n n e da e r i a l v e h i c l es y s t e mf o r f a s te x p l o r a t i o no f l a r g ec o m p l e x i n d o o re n v i r o n m e n t sJ J o u r n a lo fF i e l dR o b o t i c s,():Z h a oY,Y a nL,C h e nY,e ta l R o b u s ta n de f f i c i e n t t r a j e c t o r yr e p l a n n i n gb a s e do ng u i d i n gp a t hf o rq u a d r o t o rf a s ta u t o n o m o u s f l i g h tJ R e m o t eS e n s i n g,():H o r n u n gA,W u r m K M,B e n n e w i t z M,e ta l O c t o M a p:A ne f f i c i e n tp r o b a b i l i s t i c Dm a p p i n g f r a m e w o r kb a s e do no c t r e e sJ A u t o n o m o u sR o b o t s,():C h e nJ,L i uT,S h e nS O n l i n e g e n e r a t i o no f c o l l i s i o n f r e e t r a j e c t o r i e s f o r q u a d r o t o r f l i g h t i nu n k n o w n c l u t t e r e d e n v i r o n m e n t sC/I E E EI n t e r n a t i o n a lC o n f e r e n c e o nR o b o t i c s a n dA u t o m a t i o n(I C R A)S t o c k h o l m,S w e d e n:I E E E,:J iJ,W a n gZ,W a n gY,e ta l M a p l e s s p l a n n e r:Ar o b u s ta n df a s tp l a n n i n gf r a m e w o r kf o ra g g r e s s i v ea u t o n o m o u sf l i g h tw i t h o u tm a pf u s i o nC/I E E EI n t e r n a t i o n a lC o n f e r e n c eo nR o b o t i c sa n dA u t o m a t i o n(I C R A)X i a n,C h i n a:I E E E,:F l o r e n c ePR,C a r t e rJ,W a r eJ,e ta l N a n o m a p:F a s t,u n c e r t a i n t y a w a r ep r o x i m i t yq u e r i e sw i t hl a z ys e a r c ho v e rl o c a l dd a t aC/I E E EI n t e r n a t i o n a lC o n f e r e n c eo nR o b o t i c sa n dA u t o m a t i o n(I C R A)B r i s b a n e,Q L D,A u s t r a l i a:I E E E,:R a t l i f fN,Z u c k e rM,B a g n e l l JA,e t a l C HOMP:G r a d i e n to p t i m i z a t i o n t e c h n i q u e s f o r e f f i c i e n t m o t i o n p l a n n i n gC/I E E EI n t e r n a t i o n a lC o n f e r e n c eo n R o b o t i c sa n dA u t o m a t i o n K o b e,J a p a n:I E E E,:W uZ,M e n gZ S a f ep o l y n o m i a l t r a j e c t o r yg e n e r a t i o nf o rq u a d r o t o r f l i g h ti nd e n s ee n v i r o n m e n t sM S i n g a p o r e:S p r i n g e rS i n g a p o r e,W o o d sAC,L aH M An o v e lp o t e n t i a l f i e l dc o n t r o l l e rf o ru s eo na e r i a lr o b o t sJ I E E E T r a n s a c t i o n so nS y s t e m s,M a n,a n dC y b e r n e t i c s:S y s t e m s,():K l a n ca rG,S e d e rM,B l a zi cS,e t a l D r i v a b l ep a t hp l a n n i n gu s i n gh y b r i ds e a r c ha l g o r i t h mb a s e do nE a n db e r n s t e i n b z i e rm o t i o np r i m i t i v e sJ I E E ET r a n s a c t i o n so nS y s t e m s,M a n,a n dC y b e r n e t i c s:S y s t e m s,():Q u a nL,Z h a n gZ,Z h o n gX,e t a l E VA p l a n n e r:E n v i r o n m e n t a l a d a p t i v eq u a d r o t o rp l a n n i n gC/I E E EI n t e r n a t i o n a l C o n f e r e n c e o n R o b o t i c s a n d A u t o m a t i o n(I C RA)X i a n,C h i n a:I E E E,:Z h o uB,G a oF,P a n J,e t a l R o b u s t r e a l t i m e u a v r e p l a n n i n gu s i n gg u i d e dg r a d i e n t b a s e do p t i m i z a t i o na n dt o p o l o g i c a lp a t h sC/I E E EI n t e r n a t i o n a lC o n f e r e n c eo nR o b o t i c sa n dA u t o m a t i o n(I C R A)P a r i s,F r a n c e:I E E E,:T a n gL,W a n gH,L i P,e t a l R e a l t i m e t r a j e c t o r yg e n e r a t i o n f o r q u a d r o t o r