更全的杂志信息网

无人直升机目标定位系统设计

更新时间:2009-03-28

无人直升机因其特有的可悬停、载荷能力强和机动性能好等优势在低空乃至近地面的应用里有着不可替代的作用,越来越多的研究人员在该领域进行探索与尝试。其中,无人直升机对其周边环境的探测与感知成为其安全飞行以及能否走向深层次应用的关键[1]

目前,无人直升机可用超声波、计算机视觉和激光雷达等多种方法进行目标检测与定位[2]。超声波在倒车雷达、测距仪等场合应用广泛,但超声波测距短,且在无人直升机上使用极易受到干扰,影响测量精度。计算机视觉是当前研究热点,但是用视觉进行目标定位计算量大,对处理器要求高,设备价格昂贵。激光雷达测程大、测量频率快且精度高,具有较高的实用和商用价值[3-4]。Wallace等[5]利用无人机搭载激光雷达扫描树木的树冠层以实现森林管理的决策过程。Chisholm等[6]利用激光雷达帮助无人机在全球定位系统(Global position system,GPS)等导航信息受干扰的情况下在森林中完成作业。李冰等[7]利用无人机机载激光雷达对电网及塔杆进行建模并生成环境模型。邢承海[8]针对散料码头的超宽露天散料堆场的三维建模需求,设计了一种基于无人机激光扫描的堆场建模系统。

上述研究将激光雷达与无人机相结合,为无人机的实际应用提供了大量新思路。为了进一步提高小型无人直升机自主飞行作业的精准度,需要精确控制无人机与作业目标间的相对位置[9]。同时,复杂环境中的障碍物也会对无人机飞行状态的测量造成干扰。为解决上述问题,本文自主研发设计了一套激光雷达数据采集处理系统用于目标定位。

1 系统硬件组成

测量系统硬件组成如图1所示,其中UTM-30LX激光雷达用于扫描目标并建立环境模型,信号转换模块用于USB信号和串口信号之间的转换,电源模块给整个测量系统供电,数据处理模块用于数据处理及算法实现。

  

图1 系统硬件方框图Fig.1 System hardware block diagram

1.1 UTM-30LX激光雷达

UTM-30LX是一款结合了激光技术与雷达技术的先进探测系统,具有高精度、高分辨率、宽视场、低质量和低功耗等特点,可用于机器人环境识别、安防系统和自动导航等领域,如图2所示,其主要性能参数如表1所示。

  

图2 UTM-30LX激光雷达Fig.2 UTM-30LX lidar

 

表1 激光雷达性能参数

 

Tab.1 Performance parameter of lidar

  

项目性能参数质量/g370尺寸/(mm×mm×mm)60×60×87工作电压12VDC±10%激光光源/nm半导体激光二极管(λ=905)测量距离/m0.1~30测量范围/(°)0~270测量精度0.1~10m:±30mm10~30m:±50mm分辨率/(°)0.25(270°/1080steps)扫描时间/ms25接口USB2.0

激光雷达测量原理是借助激光束的发射与回波接收对目标进行扫描建模从而探测目标所处的距离和方位。其对周围环境的扫描建模结果如图3所示。

  

图3 激光雷达扫描建模结果Fig.3 Modeling result of lidar scanning

激光雷达有效检测范围为270°,分辨率为0.25°,即每扫描0.25°返回一次距离值。扫描方向为逆时针,每个扫描周期内返回1 081个点的数据,从-45°(Step A)开始扫描,到225°(Step C)结束扫描,如图4所示。测量点A,B,C的代码分别对应为0,540,1 080,其他点的代码可以依次推算出。

  

图4 激光雷达扫描范围Fig.4 Range of lidar scanning

1.2 信号转换模块

激光雷达测量的数据通过USB串行总线输出,当数据处理模块硬件不具备USB串口时需要对信号进行转换。本设计采用VDIP1模块来实现。该模块是FTDI公司开发的信号转换模块,专用于USB信号到串口信号的转换,如图5所示。

  

图5 VDIP1信号转换模块Fig.5 VDIP1 signal transformation module

该模块使用VNC1L芯片作为微控制器,工作电压为5 V。

1.3 数据处理模块

数据处理模块负责信号采集、数据处理、目标距离和方位确定、实时向上位机返回数据等。模块选用STM32F103CBT6嵌入式微控制器,其工作主频72 MHz,具有多个输入输出口,最多3个串口外设,独立看门狗和窗口看门狗[10,11]

数据处理模块电路原理设计以微控制器芯片为核心,搭配相关元器件,构成最小系统。

激光雷达测量的数据经由信号转换模块后进入数据处理模块进行处理。同时,数据处理模块将解算后的结果发送至上位机,接口电路支持RS232和RS422通信标准。

数据处理模块采用5 V供电,其实物图如图6所示。

30%划分训练集和测试集的情况下SVM分类器对测试集的识别准确性分析,表5展示的是以80%:20%划分训练集和测试集情况下SVM分类器对测试集的识别准确性分析。

  

图6 数据处理模块Fig.6 Data processing module

2 系统应用软件设计

该系统的应用软件设计方案按照模块化方式完成,用C语言在KEIL MDK5集成开发环境下编写,其运行流程如图7所示。在后台主程序循环中,通过串口接收中断服务函数进行激光雷达数据返回数据帧的解包,通过串口发送中断服务函数向上位机返回实时测量结果。

  

图7 系统运行流程图Fig.7 System flow chart

2.1 系统初始化

程序开始运行后,首先对整个系统的时钟、串口以及激光雷达进行初始化。配置处理器的主频为72 MHz,系统定时器每1 ms计数一次。将串口波特率设置为115 200,无校验位,8个数据位,1个停止位。

激光雷达初始化中,设置其扫描范围为0°~180°,每隔0.5°返回一次距离值,即总共返回361个测量点的距离值,激光雷达扫描频率为40 Hz且连续返回数据。

2.2 激光雷达数据解包

3.智能网联汽车软件、算法、地图等的更新升级,汽车制造商或软件供应商已及时发布了通知,用户也已及时地更新升级,用户没有任何不当操作或控制,如发生交通肇事犯罪,则推定为自动驾驶系统制造商或供应商承担法律责任。

 

表2 激光雷达数据编码格式

 

Tab.2 Data encoding format of lidar

  

数据字节字节内容备注帧头2MD固定码数据码16起始测量点结束测量点间隔点数扫描频率扫描次数激光雷达的配置返回码回车符1OA固定码格式符499bOA固定码数据码4时间标志时间标志校验码1校验和前面数据求和的低8位回车符1OA固定码数据码测量数据每个扫描点的数据校验码1校验和前面数据求和的低8位回车符1OA固定码回车符1OA固定码

系统应用程序中按照此编码格式对361个距离量进行解包。

2.3 数据预处理

对测量结果造成误差的原因有以下3点:

近几年,随着自媒体等新兴业态的蓬勃发展,报纸等传统媒体受到极大的冲击,数字报纸市场整体规模也因此出现逐年下降的趋势。自2012年我国数字报纸收入总值和收入占比达到顶峰后,近几年一直呈小幅度下滑趋势,但下滑趋势减缓。相关数据显示,2017年我国数字报纸市场规模从9.0亿元下降到了8.6亿元(见图2),下降趋势逐年减缓。

基于上述3点,数据处理模块在进行目标定位前需对采集的数据进行预处理,识别出有效区域,如图8所示。

(2) 由于物体移动、混合像素点和表面材料等关键因素的影响,激光雷达某一固定扫描线在采集数据的过程中会产生一些噪点。

(3) 扫描范围内可能出现障碍物,这会对任务目标的定位造成干扰。

(1) 激光雷达有效测量范围为0.1~30 m,低于0.1 m时相对测量误差很大,而超出30 m时测量到的数据为0。

  

图8 有效区域示意图Fig.8 Diagram of effective area

针对第1点,考虑到无人直升机在实际作业时与目标的位置关系,设置测量值范围为0.5~20 m,用于剔除不在此范围内的无效数据。

针对第2点,由于噪点随机出现,且其函数形式较为复杂,要消除这一误差,本文采用滑动均值法对原始数据进行滤波。该方法适用于高频振荡的系统,对周期性干扰有良好的抑制作用,平滑度高。同时,该方法采用递推形式进行计算,滤波结果实时更新,便于快速处理非平稳数据[12]

写寄存器命令时上位机发送命令:[下位机设备地址][访问下位机命令号(06)][设置的寄存器地址高8位][设置的寄存器地址的低8位][写入下位机的数据高8位][写入下位机的数据的低8位][CRC校验结果的低8位][CRC校验结果的高8位],下位机接收到上位机命名,完成操作后将原命令内容发回给上位机。

根据图12可以分析出:(1)扫描范围内有3块连续区域。(2)第2块区域包含扫描线的数量最多。

 

(1)

本文取m=5,即依次求时间序列上相邻5次测量结果的平均值。对激光雷达90°扫描线上的一组测量值进行滑动均值滤波,由图9可以看出,该方法有效消除了随机误差。

  

图9 滑动均值滤波结果Fig.9 Result of sliding average method

针对第3点,考虑到本文无人直升机作业环境中障碍物较少,且扫描区域无断裂特征,故使用基于坡度的方法[13]筛选出有效扫描范围。此类方法首先选取种子点,再通过比较种子点与邻近点之间的距离变化程度(即坡度)来滤除障碍物,如图10所示。

  

图10 扫描示意图Fig.10 Diagram of scanning

Li为某一时刻扫描线i上经滑动均值滤波处理后的距离值,Li+1为间隔0.5°处的距离值,依此类推。故坡度的计算公式为

 

(2)

因为相邻扫描线间隔角度固定为0.5°,所以扫描区域为某一连续区域时,坡度几乎不变,而当扫描至不连续区域时,坡度会突然增大。故可以根据坡度的这一特点,有效判断出不连续区域。设置坡度阀值Sth,当Si<Sth时,该点在连续区域内。若Si>Sth,则该点是两个不连续区域的分界点。

在完成上述步骤之后,要对其进行加水处理,一直到相对应的刻度为止,并且对其进行混合搅匀[16-19]。在搅匀之后,要对其进行放置,放置时间控制为0.5h,同时还要对其进行抽滤处理,抽滤3次即可。在抽滤的时候一定要将初次的滤液舍弃,对其他滤液进行收集,为后期使用提供有效保障。

  

图11 一组扫描结果Fig.11 Scanning result of one group

  

图12 坡度曲线图Fig.12 Diagram of slope

将激光雷达某一扫描线i在时间t上的测量值作为时间序列其在m个相邻数据的小区间上是接近平稳的,在这一小区间上作局部平均以减少随机误差造成的起伏。再在逐一小区间上进行不断的局部平均,即可得到较为平滑的测量结果而滤除频繁起伏的随机误差,其中

某一组扫描结果如图11所示,根据式(2)计算得到坡度,并设置坡度阀值Sth=0.1,结果如图12所示。

故可以判断出,区域1和区域3为障碍物,区域2为无人直升机的作业目标,记区域2起始扫描线索引值为N0,截止扫描线索引值为NS

2.4 目标定位算法

本文最终目的是得到无人直升机到目标的距离L (90°扫描方向的距离),最短距离Lmin,方位角φ,扫描起始线角度δ0,扫描终止线角度δS以及有关状态标志量,各状态量说明如图13所示。

  

图13 状态量示意图Fig.13 Diagram of status value

为了表征无人直升机相对于目标的位置,程序中定义Position_Flag这一变量对不同位置状态进行区分,如图14所示。

煤泥水中固体物的粒度组成对煤泥水沉降有重要影响。在煤泥水体系中,固体物质主要由有机煤质和矿物质构成。煤颗粒较易沉降,而粘土矿物较难沉降。一般来说,大于75 μm的颗粒状煤泥易于沉降、脱水和精选,而小于75 μm的颗粒状煤泥难于沉降。因此,煤泥水中小于75 μm微细煤泥颗粒含量越高,处理难度越大。各样品的粒度分析见表2。

  

图14 Position_Flag标志说明Fig.14 Description of Position_Flag

当Position_Flag=3,即90°线扫在目标左侧时,如图15所示,其中α,β,θ,γ分别为解算过程中用到的变量。

  

图15 Position_Flag=3时示意图Fig.15 Diagram of Position_Flag=3

因为相邻扫描线间的角度为0.5°,故

α=(NS-N0)×0.5

(3)

根据相应几何关系,有

 

(4)

 

(5)

 

(6)

其中LBD为有效区域的宽度,可以求出

 

(7)

因为90°方向扫描线的索引值为180,故

θ=(180-NS)×0.5

(8)

所求无人直升机与目标的方位角φ

φ=180-(β-θ)

(9)

(1) 独立测试阶段。该阶段通过搭建不同的实验环境对测量系统进行单独测试,主要验证算法的正确性以及硬件的可靠性。同时,在该阶段对上位机软件进行测试,实时显示测量结果,某一次试验的结果如图18所示。

 

(10)

当Position_Flag=2,即90°线扫在目标上时,如图16所示。

  

图16 Position_Flag=2时示意图Fig.16 Diagram of Position_Flag=2

与Position_Flag=3的情况类似,可以求出α,β,LBDLmin,不同的是

我会告诉她:“任何人,即使是你认识的,如果让你感到不舒服,你就可以拒绝,你就可以第一时间向妈妈求助。”

调查显示,非英语专业本科生学习英语词汇主要依赖于教师的课堂教学和教材的内容,教师的词汇教学方法就显得尤为重要。比如,关于构词法的策略,不管是好学生多的A班还是差学生多的B班,作为授课教师,笔者在这个学年高度重视讲授和强调,调查显示已经有很大一部分学生能经常运用构词法策略来学习单词。所以,教师要注重教授学生词汇学习的策略,以帮助他们更有效地学习英语词汇。

θ=(NS-180)×0.5

(11)

故无人直升机与目标的方位角φ

骨盆、髋关节周围肌群等长收缩训练对脑卒中后遗症期患者步行功能的影响………………………………………………………………… 牛博真,张向宇,田恺,等 32

φ=180-(β+θ)

(12)

因为90°线扫在目标上,所以无人直升机到目标的距离L可以直接得出。

当Position_Flag=1,即90°线扫在目标右侧时,解算方法和Position_Flag=3时类似,这里不再赘述。

历来乐视的新品发布或者各种会议给市场描绘美好概念与未来,并用讲故事的方式刺激着股价与投资者的澎湃内心。这也是筹集资金的一种乐视重要的方式,但这种侃式吹牛的模式容易给企业带来浮躁跃进的气氛,不利于企业稳定发展,乐视应加强内部控制,从经营管理上做出改变,用切实的内容产品吸引消费者吸引融资方可实现良性循环。从2015年后乐视的新一轮经营管理决策来看,其所实施的多元化战略需要更大的资金需求量。

2.5 数据返回

解算完成后的最终数据按照表3所示的数据协议打包发送给上位机。

 

表3 数据帧打包格式

 

Tab.3 Package format of data frame

  

数据字节字节内容备注报头标志2MYMH固定码发送接收地址1M+S(高低位区分)高4位发送低4位接收功能码103定时返回数据请求字节长度1XX定时返回方式返回的字节长度起始地址2AAHBBH定时返回方式读取的寄存器起始地址为BBAAH寄存器数据01*(BBAA)寄存器存储的数据内容寄存器数据11*(BBAA+1)寄存器存储的数据内容︙︙︙寄存器存储的数据内容尾码2返回标志0:不需要返回答校验和各字节求和所得到的低8位值

3 上位机与功能测试

3.1 上位机软件设计

上位机软件主要实现接收下位机采集处理的数据,并且实时显示,可以方便地对整个测量系统进行独立测试。本文的上位机软件采用LABVIEW进行开发,这是一种用图标代替文本行创建应用程序的图形化编程语言,并广泛应用于测试领域,一般LABVIEW程序包括前面板界面和后台程序框图,两者通过虚拟仪表控件实现数据交互[14]

上位机运行框架如图17所示,测量系统与上位机通过RS232串口实现数据传输,首先调用虚拟仪器软件架构(Virtual instrument software architecture,VISA )接口函数库对串口号、波特率、数据位和校验位等进行配置。再按照通讯协议对数据帧进行解包,最后通过虚拟仪表显示在前面板中。

  

图17 上位机运行框架Fig.17 Operating framework of host

将上位机软件前面板分成4个主要区域,分别为状态数值显示、状态标志量显示说明、串口参数选择和图形显示界面,可以直观显示出所有的状态。

3.2 试验与测试

试验与测试分为以下两个阶段:

故无人直升机到目标的距离L

  

图18 独立测试阶段Fig.18 Independent testing phase

(2) 机载测试阶段。独立测试通过后,将测量系统安装在无人直升机上,进一步对测量系统进行验证,如图19所示。

  

图19 机载测试阶段Fig.19 Airborne testing phase

4 结束语

本文基于UTM-30LX激光雷达,利用STM32设计了一套数据采集处理系统,用于无人直升机对任务目标的定位,并使用Labview开发了上位机软件对测量结果进行了直观的显示,最后将该系统应用于一款小型无人直升机上。测试结果表明,该系统运行可靠,可以准确获取无人直升机相对于任务目标的距离和方位角。

参考文献:

[1] FARID K,KENZO I,ROGELIO L. An adaptive vision-based autopilot for mini flying machines guidance,navigation and control [J]. Autonomous Robots, 2009,27(3):165-188.

[2] 余超凡,孙建辉.基于光流传感器的旋翼无人机实时避障系统[J].计算机应用软件,2018,35(1):206-210.

YU Chaofan,SUN Jianhui. A real-time obstacle avoidance system for multi-rotor unmanned aerial vehicle based on optical flow sensor [J]. Computer Applications and Software, 2018,35(1):206-210.

[3] 何志远.车载三维成像激光雷达系统研究[D].哈尔滨:哈尔滨工业大学,2015.

HE Zhiyuan. Research on 3D imaging laser radar system for vehicle[D].Harbin:Harbin Institute of Technology,2015.

[4] 吕冰,钟若飞,王嘉楠.车载移动激光扫描测量产品综述[J].测绘与空间地理信息,2012,6(6):184-195.

LV Bing,ZHONG Ruofei,WANG Jianan. Vehicle-borne mobile laser scanner products:A review[J].Geomatics & Spatial Information Technology,2012,6(6):184-195.

马铃薯黄萎病生防细菌的筛选与鉴定………………………………………………………… 申建芳,李子桀,蒙春燕,周洪友(81)

[5] WALLACE L,LUCIFER A,WATSON C. Evaluating tree detection and segmentation routines on very high resolution UAV LiDAR data [J]. IEEE Transactions on Geoscience and Remote Sensing, 2014,52(12): 7619-7628.

激光雷达测量出的数据按照表2所示格式进行编码后返回给数据处理模块。

[6] CHISHOLM R,CUI Jingqiang. UAV LiDAR for below-canopy forest surveys [J]. Journal of Unmanned Vehicle Systems,2013,1(1): 61-68.

1.4 统计学方法 采用SPSS 17.0统计软件进行处理分析,计量资料以均数±标准差(±s)表示,组间比较采用t检验,计数资料用χ2检验。

[7] 李冰,林宇龙,黄珣.基于激光雷达技术的无人机电网基建管控系统[J].现代电子技术,2018,41(2):99-106.

LI Bing,LIN Yulong,HUANG Xun. Infrastructure management and control system for UAV grid based on laser radar technology [J]. Modern Electronic Technique, 2018,41(2):99-106.

[8] 邢承海.基于无人机激光雷达的散料堆场建模系统设计[J].冶金自动化,2017,41(2):6-9.

XING Chenghai. Design of bulk yard modeling system based on UAV radar [J]. Metallurgical Industry Automation, 2017,41(2):6-9.

[9] FARID K,ZHEN Yuyu,NONAMI K. Guidance and nonlinear control system for autonomous flight of mini rotorcraft unmanned aerial vehicle [J]. Field Robotics,2010,27(3):311-334.

[10] JOSEPH Y. The definitive guide to ARM cortex-M3 and cortex-M4 processors [M].北京:清华大学出版社,2017.

JOSEPH Y. The definitive guide to ARM costex-M3 and cortex-M4 Processors[M].Beijing:Tsinghua University Press,2017.

因此,艺术与文化教育不仅要在学校范围内展开,校外同样是重要场所。一方面在于校外的公共文化机构拥有大量教育资源,青少年可以接受“直接的”艺术教育,而不是课堂内的“转述”,避免“不专业”的艺术教育带来的负面影响;另一方面,确保学校体系之外(如辍学)的青少年也能平等享有艺术与文化教育的权利。

[11] 廖义奎.ARM Cortex-M4 嵌入式实战开发精解[M].北京:北京航空航天大学出版社,2013.

LIAO Yikui. ARM cortex-M4 embedded development[M].Beijing:Beihang University Press,2013.

[12] 裴益轩,郭民.滑动平均法的基本原理及应用[J].火炮发射与控制学报,2001(1):21-23.

PEI Yixuan,GUO Min. The fundamental principle and application of sliding average method [J]. Gun launch & Control Journal, 2001(1): 21-23.

[13] 张皓,贾新梅.基于虚拟网格与改进坡度滤波算法的机载LIDAR数据滤波[J],测绘科学技术学报,2009,26(3): 224-231.

ZHANG Hao,JIA Xinmei. Filtering of airborne LIDAR data based on pseudo-grid concept and modified slope filtering algorithm [J]. Journal of Geomatics Science and Technology, 2009,26(3): 224-231.

[14] 阮奇桢.我和LabVIEW[M].北京:北京航空航天大学出版社,2009.

RUAN Qizhen. I and LabVIEW[M].Beijing:Beihang Universiiy Press,2009.

 
黄益新,徐锦法
《南京航空航天大学学报》2018年第02期文献

服务严谨可靠 7×14小时在线支持 支持宝特邀商家 不满意退款

本站非杂志社官网,上千家国家级期刊、省级期刊、北大核心、南大核心、专业的职称论文发表网站。
职称论文发表、杂志论文发表、期刊征稿、期刊投稿,论文发表指导正规机构。是您首选最可靠,最快速的期刊论文发表网站。
免责声明:本网站部分资源、信息来源于网络,完全免费共享,仅供学习和研究使用,版权和著作权归原作者所有
如有不愿意被转载的情况,请通知我们删除已转载的信息 粤ICP备2023046998号