首页 / 专利分类库 / 控制;调节 / 非电变量的控制或调节系统 / 一种基于语义信息辅助的无人机位姿优化方法及系统

一种基于语义信息辅助的无人机位姿优化方法及系统

申请号 CN202311015336.0 申请日 2023-08-14 公开(公告)号 CN117970937A 公开(公告)日 2024-05-03
申请人 广西电网有限责任公司电力科学研究院; 南方电网科学研究院有限责任公司; 发明人 祝文姬; 纪硕磊; 祁红涛; 邹林; 欧发斌; 卢万里; 卓浩泽; 刘旭; 王乐; 张龙飞; 班卫华;
摘要 本 发明 涉及 电网 技术领域,本发明所述方法包括,基于输电杆塔语义信息改进视觉 里程计 方法,并得到语义平面,将每 帧 图像中,语义平面和语义路标之间的数据关联,通过惯性预积分增加惯性约束条件以建立图像间的运动约束,实现对相机 位姿 估计状态量进行优化。本发明的方法能够帮助无人机更快地适应复杂环境,缩短了无人机 定位 和 姿态 估计的时间,有效地避免了无人机在飞行过程中与周围物体的碰撞,提高了飞行安全性。
权利要求

1.一种基于语义信息辅助的无人机位姿优化方法,其特征在于:包括,
基于输电杆塔语义信息改进视觉里程计方法,并得到语义平面;
将每图像中语义平面和语义路标之间的数据进行关联;
通过惯性预积分增加惯性约束条件以建立图像间的运动约束,实现对相机位姿估计状态量进行优化。
2.如权利要求1所述的一种基于语义信息辅助的无人机位姿优化方法,其特征在于:所述基于输电杆塔语义改进视觉里程计方法,包括对输电杆塔语义信息进行因子建模,并将语义信息与电杆塔结构特征结合,以构建所述语义平面,语义平面为所述视觉里程计方法的环境观测与位姿约束。
3.如权利要求2所述的一种基于语义信息辅助的无人机位姿优化方法,其特征在于:所述语义平面包括将语义信息与平面特征相结合,构建出语义平面,作为视觉VO额外的高维特征,为传统的VO增添除特征点之外的环境观测与约束,对语义平面特征进行因子建模,构建因子图优化方案,通过对传统视觉VO的因子图结构进行扩充与改善,语义信息辅助的改进VO在于增加语义平面特征节点
4.如权利要求3所述的一种基于语义信息辅助的无人机位姿优化方法,其特征在于:所述语义平面和语义路标之间的数据进行关联包括将图像帧中提取的语义平面与语义路标进行类别及平面类型的匹配,利用坐标变换,将语义平面的法线方向由相机坐标系转换到世界坐标系,计算语义平面形心与其相匹配的路标形心的氏距离,以确定是否将检测到的语义对象映射为语义路标,若所述马氏距离大于指定阈值,则将检测到的语义对象映射为新的语义路标,否则所述语义对象与当前的语义路标相匹配。
5.如权利要求4所述的一种基于语义信息辅助的无人机位姿优化方法,其特征在于:所述语义路标包括无人机执行任务时需要关注的特定目标以及位置,利用计算机视觉技术从图像和视频中提取出语义路标并表示,基于语义路标和无人机当前的位姿信息,通过位姿优化算法计算出无人机的最优位姿根据优化后的位姿信息,对无人机进行控制和导航,沿着最佳路径飞行并完成任务。
6.如权利要求5所述的一种基于语义信息辅助的无人机位姿优化方法,其特征在于:所述惯性预积分包括设置初始相机位姿状态量和工作状态,根据IMU的数据,计算相邻两图像帧之间的运动信息,对运动信息进行预积分,获得相邻图像帧之间的运动约束,定义惯性约束条件,使用惯性预积分公式,计算运动约束,根据计算出的运动约束,调整惯性约束条件之间的运动关系,重复上述步骤,直到惯性约束条件不再需要调整为止,运动约束计算为:
其中,ω1,ω2,ω3是惯性约束条件,p1,p2是前后两帧图像的点。
7.如权利要求6所述的一种基于语义信息辅助的无人机位姿优化方法,其特征在于:所述相机位姿估计状态量进行优化包括用卡尔曼滤波优化方法:
xt=Axt‑1+But+wt
其中,xt表示当前时刻的图像帧,xt‑1表示前一时刻的图像帧,ut表示当前时刻的控制输入,wt表示过程噪声,A、B为系统模型的参数。
8.一种采用如权利要求1~7任一所述的一种基于语义信息辅助的无人机位姿优化方法的系统,其特征在于:包括语义信息提取模、位姿估计模块、位姿优化模块、控制模块、显示器模块;
所述语义信息提取模块,从图像数据中提取出与无人机位姿相关的地面、建筑物、树木特征点的位置、大小、方向的语义信息;
所述位姿估计模块,利用提取出的语义信息,结合无人机的传感器数据,对无人机的位姿进行估计,即确定无人机的位置和朝向;
所述位姿优化模块,根据无人机的位姿估计结果和预设的优化算法,对无人机的位姿进行优化,达到特定的目标,提高飞行安全性、减少飞行误差;
所述控制模块,将优化后的位姿信息转化为控制信号,通过无人机的控制器对无人机进行控制,按照优化后的位姿进行飞行;
所述显示器模块,用于显示无人机的实时位姿信息和飞行状态,以便操作员进行监控和调整。
9.一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至7中任一项所述的方法的步骤。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至7中任一项所述的方法的步骤。

说明书全文

一种基于语义信息辅助的无人机位姿优化方法及系统

技术领域

[0001] 本发明涉及电网技术领域,尤其涉及一种基于语义信息辅助的无人机位姿优化方法。

背景技术

[0002] 由于输电线路位于户外,复杂的气候条件会引起输电线路震动、膨胀或收缩,从而导致螺栓等部件松动,造成输电线路安全隐患。目前,输电线路各种固件和功能组件基本仍由人工带电作业来完成,在高空、高电压、环境恶劣的高危条件下,人工作业效率低下,且由于特高压电网和多回路杆塔的广泛应用,电压等级越来越高、相间距离越来越近,人工带电作业极为危险,亟需研发替代人工实现线路的安全高效带电作业的方法。
[0003] 无人机作为无人载具,速度快,工作高度满足杆塔巡检的要求,可以有效代替人工作业。无人机的控制主要通过各种传感器进行数据采集以确定当前的飞行状态,并根据飞行状态进行后续控制,其中,通过视觉方式进行数据采集的方法可以实现任务数据采集和飞行控制数据采集同时进行,因此非常适合电网的工作环境。只是无人机发生快速抖动时或者场景光照强度不稳定时,纯视觉的方法或系统难以输出有效位姿结果,鲁棒性受限。

发明内容

[0004] 鉴于上述现有存在的问题,提出了本发明。
[0005] 因此,本发明提供了一种基于语义信息辅助的无人机位姿优化方法,能够可以提高无人机的定位精度,从而更好地实现无人机的自主飞行和智能化控制。
[0006] 为解决上述技术问题,本发明提供如下技术方案,一种基于语义信息辅助的无人机位姿优化方法,包括:基于输电杆塔语义信息改进视觉里程计方法,并得到语义平面,将每图像中语义平面和语义路标之间的数据关联,通过惯性预积分增加惯性约束条件以建立图像间的运动约束,实现对相机位姿估计状态量进行优化。
[0007] 作为本发明所述的一种基于语义信息辅助的无人机位姿优化方法的一种优选方案,其中:所述基于输电杆塔语义改进视觉里程计方法,包括对输电杆塔语义信息进行因子建模,并将语义信息与电杆塔结构特征结合,以构建所述语义平面,语义平面为所述视觉里程计方法的环境观测与位姿约束。
[0008] 作为本发明所述的一种基于语义信息辅助的无人机位姿优化方法的一种优选方案,其中:所述语义平面包括将语义信息与平面特征相结合,构建出语义平面,作为视觉VO额外的高维特征,为传统的VO增添除特征点之外的环境观测与约束,对语义平面特征进行因子建模,构建因子图优化方案,通过对传统视觉VO的因子图结构进行扩充与改善,语义信息辅助的改进VO在于增加语义平面特征节点
[0009] 作为本发明所述的一种基于语义信息辅助的无人机位姿优化方法的一种优选方案,其中:所述语义平面和语义路标之间的数据关联包括将图像帧中提取的语义平面与语义路标进行类别及平面类型的匹配,利用坐标变换,将语义平面的法线方向由相机坐标系转换到世界坐标系,计算语义平面形心与其相匹配的路标形心的氏距离,以确定是否将检测到的语义对象映射为语义路标,若所述马氏距离大于指定阈值,则将检测到的语义对象映射为新的语义路标,否则所述语义对象与当前的语义路标相匹配。
[0010] 作为本发明所述的一种基于语义信息辅助的无人机位姿优化方法的一种优选方案,其中:所述语义路标包括无人机执行任务时需要关注的特定目标以及位置,利用计算机视觉技术从图像和视频中提取出语义路标并表示,基于语义路标和无人机当前的位姿信息,通过位姿优化算法计算出无人机的最优位姿根据优化后的位姿信息,对无人机进行控制和导航,沿着最佳路径飞行并完成任务。
[0011] 作为本发明所述的一种基于语义信息辅助的无人机位姿优化方法的一种优选方案,其中:所述惯性预积分包括设置初始相机位姿状态量和工作状态,根据IMU的数据,计算相邻两图像帧之间的运动信息,对运动信息进行预积分,获得相邻图像帧之间的运动约束,定义惯性约束条件,使用惯性预积分公式,计算运动约束,根据计算出的运动约束,调整惯性约束条件之间的运动关系,重复上述步骤,直到惯性约束条件不再需要调整为止,运动约束计算为:
[0012]
[0013]
[0014]
[0015] 其中,ω1,ω2,ω3是惯性约束条件,p1,p2是前后两帧图像的点。
[0016] 作为本发明所述的一种基于语义信息辅助的无人机位姿优化方法的一种优选方案,其中:所述相机位姿估计状态量进行优化包括用卡尔曼滤波优化方法:
[0017] xt=Axt‑1+But+wt
[0018] 其中,xt表示当前时刻的图像帧,xt‑1表示前一时刻的图像帧,ut表示当前时刻的控制输入,wt表示过程噪声,A、B为系统模型的参数。
[0019] 本发明的另一个目的是提供一种基于语义信息辅助的无人机位姿优化方法的系统,其能通过利用无人机传感器获取的环境语义信息,结合定位和姿态估计算法,对无人机的位姿进行优化调整。
[0020] 一种基于语义信息辅助的无人机位姿优化方法的系统,其特征在于:包括语义信息提取模、位姿估计模块、位姿优化模块、控制模块、显示器模块;
[0021] 所述语义信息提取模块,从图像数据中提取出与无人机位姿相关的地面、建筑物、树木特征点的位置、大小、方向的语义信息;
[0022] 所述位姿估计模块,利用提取出的语义信息,结合无人机的传感器数据,对无人机的位姿进行估计,即确定无人机的位置和朝向;
[0023] 所述位姿优化模块,根据无人机的位姿估计结果和预设的优化算法,对无人机的位姿进行优化,达到特定的目标,提高飞行安全性、减少飞行误差;
[0024] 所述控制模块,将优化后的位姿信息转化为控制信号,通过无人机的控制器对无人机进行控制,按照优化后的位姿进行飞行;
[0025] 所述显示器模块,用于显示无人机的实时位姿信息和飞行状态,以便操作员进行监控和调整。
[0026] 一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现一种基于语义信息辅助的无人机位姿优化方法的步骤。
[0027] 一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现一种基于语义信息辅助的无人机位姿优化方法的步骤。
[0028] 本发明的有益效果:基于输电杆塔语义信息改进视觉里程计方法,并得到语义平面,能够在视觉里程计方法的基础上改进,以优化识别和定位的效果;将每帧图像中,语义平面和语义路标之间的数据关联,进一步优化识别和定位的效果;通过惯性预积分增加惯性约束条件以建立图像间的运动约束,实现对相机位姿估计状态量进行优化,能够实现对位姿信息的优化。附图说明
[0029] 为了更清楚地说明本发明实施例的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。其中:
[0030] 图1为本发明一个实施例提供的一种基于语义信息辅助的无人机位姿优化方法流程示意图;
[0031] 图2为本发明一个实施例提供的一种基于语义信息辅助的无人机位姿优化方法的系统的工作流程示意图。

具体实施方式

[0032] 为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合说明书附图对本发明的具体实施方式做详细的说明,显然所描述的实施例是本发明的一部分实施例,而不是全部实施例。基于本发明中的实施例,本领域普通人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明的保护的范围。
[0033] 在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是本发明还可以采用其他不同于在此描述的其它方式来实施,本领域技术人员可以在不违背本发明内涵的情况下做类似推广,因此本发明不受下面公开的具体实施例的限制。
[0034] 其次,此处所称的“一个实施例”或“实施例”是指可包含于本发明至少一个实现方式中的特定特征、结构或特性。在本说明书中不同地方出现的“在一个实施例中”并非均指同一个实施例,也不是单独的或选择性的与其他实施例互相排斥的实施例。
[0035] 本发明结合示意图进行详细描述,在详述本发明实施例时,为便于说明,表示器件结构的剖面图会不依一般比例作局部放大,而且所述示意图只是示例,其在此不应限制本发明保护的范围。此外,在实际制作中应包含长度、宽度及深度的三维空间尺寸。
[0036] 同时在本发明的描述中,需要说明的是,术语中的“上、下、内和外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一、第二或第三”仅用于描述目的,而不能理解为指示或暗示相对重要性。
[0037] 本发明中除非另有明确的规定和限定,术语“安装、相连、连接”应做广义理解,例如:可以是固定连接、可拆卸连接或一体式连接;同样可以是机械连接、电连接或直接连接,也可以通过中间媒介间接相连,也可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
[0038] 实施例1
[0039] 参照图1,为本发明的第一个实施例,该实施例提供了一种基于语义信息辅助的无人机位姿优化方法,包括:
[0040] S1:基于输电杆塔语义信息改进视觉里程计方法,并得到语义平面。
[0041] 更进一步的,所述基于输电杆塔语义改进视觉里程计方法,包括对输电杆塔语义信息进行因子建模,并将语义信息与电力杆塔结构特征结合,以构建所述语义平面,语义平面为所述视觉里程计方法的环境观测与位姿约束。
[0042] 更进一步的,输电杆塔语义信息进行因子建模,并与传统的视觉里程计方法进行融合;语义信息通常需要与一些具体的特征相结合,为其提供相应的概念与约束,才能与传统的VO融合(即视觉里程计Visual Odometry),辅助提高位姿优化精度。拟将语义信息与平面特征相结合,构建出语义平面,作为视觉VO额外的高维特征,为传统的VO增添除特征点之外的环境观测与约束。
[0043] 更进一步的,对语义平面特征进行因子建模,构建相应的因子图优化方案,通过对传统视觉VO的因子图结构进行扩充与改善,以提高无人机的导航定位精度。语义信息辅助的改进VO与传统VO因子图融合框架的区别主要在于增加了语义平面特征节点。可以用圆圈表示因子图的优化节点,节点间的连线表示两节点之间存在相应的约束关系,这些约束关系通过连线上的方块进行表示;Ti表示第i关键帧时刻相机的位姿,pi表示构建的第i个传统特征点,li表示构建的第i个语义平面特征;其中,框架中包括语义平面观测约束,和VO得到的帧间相对位姿约束,传统特征点的观测约束;传统VO由于只提取低维的点特征,因此其构建的因子图模型中只包含特征点与相机位姿节点,且构建的约束只包括二者之间的观测约束。
[0044] 应说明的是,在传统VO的基础上实现了语义信息辅助的VO因子图结构则为本方案。在传统算法的基础上,首先根据VO量测,增添帧间相对位姿约束因子,为相邻两关键帧之间提供直接的相对位姿约束,而后通过语义平面的特征提取及数据关联,获取关键帧与语义平面特征之间的观测约束,并进行相应的因子构建。
[0045] S2:将每帧图像中,语义平面和语义路标之间的数据关联。
[0046] 更进一步的,所述将每帧图像中,语义平面和语义路标之间的数据关联,包括将图像帧中提取的语义平面与语义路标进行类别及平面类型的匹配,利用坐标变换,将语义平面的法线方向由相机坐标系转换到世界坐标系,计算语义平面形心与其相匹配的路标形心的马氏距离,以确定是否将检测到的语义对象映射为语义路标,若所述马氏距离大于指定阈值,则将检测到的语义对象映射为新的语义路标,否则所述语义对象与当前的语义路标相匹配。。
[0047] 应说明的是,在完成语义路标设置后,通过以下3个步骤实现每帧检测语义平面Sk与语义路标之间的数据关联:1)将从帧中提取的语义平面与语义路标进行类别及平面类型的匹配。匹配成功后,计算语义平面的点个数及区域面积。本项目为点云数据及语义平面面积分别设置了最小阈值:tp和ta,用于删除由于检测边界框不完全适合语义对象导致的质心坐标存在偏差的语义平面。经过上述检测,匹配成功的语义平面才能进行后续匹配,否则匹配失败。2)而后,利用坐标变换,将语义平面的法线方向由相机坐标系转换到世界坐标系,得到lnk,将其与语义路标的法向lnl进行匹配。若lnk与lnl之间的偏差小于设定的阈值ln,则认为语义平面与路标法向一致,进入后续的坐标关联,否则匹配失败。3)通过上述两步骤,将语义平面的形心由相机坐标系转换到世界坐标系,计算语义平面形心与其相匹配的路标形心(路标形心:先验语义平面的几何中心)的马氏距离,若大于设定的阈值,则将检测到的语义对象映射为新的语义路标lj,否则语义对象与当前的语义路标li相匹配。利用语义平面特征构建及数据关联,可以得到补充的相机关键帧位姿帧间约束。
[0048] S3:通过惯性预积分增加惯性约束条件以建立图像间的运动约束,实现对相机位姿估计状态量进行优化。
[0049] 更进一步的,所述惯性预积分包括设置初始相机位姿状态量和工作状态,根据IMU的数据,计算相邻两图像帧之间的运动信息,对运动信息进行预积分,获得相邻图像帧之间的运动约束,定义惯性约束条件,使用惯性预积分公式,计算运动约束,根据计算出的运动约束,调整惯性约束条件之间的运动关系,重复上述步骤,直到惯性约束条件不再需要调整为止,运动约束计算为:
[0050]
[0051]
[0052]
[0053] 其中,ω1,ω2,ω3是惯性约束条件,p1,p2是前后两帧图像的点。
[0054] 应说明的是,拟构建的语义视觉/惯性融合系统框图包括两方面:视觉信息的处理和惯性信息的处理,其中,视觉信息的处理包括:语义特征的提取,特征的关联;传统点特征跟踪运动估计;结合特征关联和运动估计,输出视觉信息处理结果。惯性信息的处理包括:惯性预积分,联合优化(即结合视觉信息处理结果),优化后的估计位姿。IMU预积分在视觉关键帧之间进行,得到的是两关键帧之间的惯性预积分约束,在构建好约束之后,与语义VO联合进行优化量的优化求解。
[0055] 更进一步的,所述相机位姿估计状态量进行优化包括用卡尔曼滤波优化方法:
[0056] xt=Axt‑1+But+wt
[0057] 其中,xt表示当前时刻的图像帧,xt‑1表示前一时刻的图像帧,ut表示当前时刻的控制输入,wt表示过程噪声,A、B为系统模型的参数。
[0058] 实施例2
[0059] 本发明的一个实施例,提供了一种基于语义信息辅助的无人机位姿优化方法,为了验证本发明的有益效果,通过实验进行科学论证。
[0060] 选择一处具有复杂环境的场地,包括建筑物、树木、电线杆,在实验场地中设定一个起降点,无人机从该起点起飞。设置一个目标点,要求无人机沿着最短路径飞行并到达目标点。在无人机飞行过程中,记录以下数据,方法1为传统方法,方法2为我方发明,表1为实验结果:
[0061] 表1
[0062]
[0063] 可以得出,使用本发明的基于语义信息辅助的无人机位姿优化方法,无人机在复杂环境下的位姿精度得到显著提高,降低了飞行误差。
[0064] 应说明的是,以上实施例仅用于说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的精神和范围,其均应涵盖在本发明的权利要求范围当中。
[0065] 实施例3
[0066] 本发明第三个实施例,其不同于前两个实施例的是:
[0067] 所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘只读存储器(ROM,Read‑Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
[0068] 在流程图中表示或在此以其他方式描述的逻辑和/或步骤,例如,可以被认为是用于实现逻辑功能的可执行指令的定序列表,可以具体实现在任何计算机可读介质中,以供指令执行系统、装置或设备(如基于计算机的系统、包括处理器的系统或其他可以从指令执行系统、装置或设备取指令并执行指令的系统)使用,或结合这些指令执行系统、装置或设备而使用。就本说明书而言,“计算机可读介质”可以是任何可以包含、存储、通信、传播或传输程序以供指令执行系统、装置或设备或结合这些指令执行系统、装置或设备而使用的装置。
[0069] 计算机可读介质的更具体的示例(非穷尽性列表)包括以下:具有一个或多个布线的电连接部(电子装置)、便携式计算机盘盒(磁装置)、随机存取存储器(RAM)、只读存储器(ROM)、可擦除可编辑只读存储器(EPROM或闪速存储器)、光纤装置以及便携式光盘只读存储器(CDROM)。另外,计算机可读介质甚至可以是可在其上打印所述程序的纸或其他合适的介质,因为可以例如通过对纸或其他介质进行光学扫描,接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得所述程序,然后将其存储在计算机存储器中。
[0070] 应当理解,本发明的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中,多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来实现。例如,如果用硬件来实现,和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。
[0071] 实施例4
[0072] 参照图2,为本发明的一个实施例,提供了一种基于语义信息辅助的无人机位姿优化方法的系统,其特征在于:包括语义信息提取模块、位姿估计模块、位姿优化模块、控制模块、显示器模块。
[0073] 语义信息提取模块,从图像数据中提取出与无人机位姿相关的地面、建筑物、树木特征点的位置、大小、方向的语义信息。
[0074] 位姿估计模块,利用提取出的语义信息,结合无人机的传感器数据,对无人机的位姿进行估计,即确定无人机的位置和朝向。
[0075] 位姿优化模块,根据无人机的位姿估计结果和预设的优化算法,对无人机的位姿进行优化,达到特定的目标,提高飞行安全性、减少飞行误差。
[0076] 控制模块,将优化后的位姿信息转化为控制信号,通过无人机的控制器对无人机进行控制,按照优化后的位姿进行飞行。
[0077] 显示器模块,用于显示无人机的实时位姿信息和飞行状态,以便操作员进行监控和调整。
[0078] 应说明的是,以上实施例仅用于说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的精神和范围,其均应涵盖在本发明的权利要求范围当中。
QQ群二维码
意见反馈