CN111486841B - 一种基于激光定位***的无人机导航定位方法 - Google Patents
一种基于激光定位***的无人机导航定位方法 Download PDFInfo
- Publication number
- CN111486841B CN111486841B CN202010426152.3A CN202010426152A CN111486841B CN 111486841 B CN111486841 B CN 111486841B CN 202010426152 A CN202010426152 A CN 202010426152A CN 111486841 B CN111486841 B CN 111486841B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- laser positioning
- state
- data
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种基于激光定位***的无人机导航定位方法,步骤1,无人机传感器健康检查,根据传感器输出的数据剔除坏点数据;步骤2,通过激光加惯性导航***进行组合导航滤波;步骤3,组合导航算法的一致性检查和组合导航算法健康检查,得到稳定的无人机姿态和位置数据。本发明的Laser(激光)+INS(Inertial navigation system惯性导航***)进行组合导航滤波,这种方法不仅可以实时输出无人机的位置和姿态信息,还可以得到很高的位置和姿态精度,并且可以得到平滑精准的无人机速度,还可以降低无线数据链配置要求。
Description
技术领域
本发明属于无人机定位技术领域,特别涉及一种基于激光定位***的无人机导航定位 方法。
背景技术
为了便于研究无人机集群算法,编队协同算法,人工智能算法,智能控制算法,路径规划算法,智能避障算法的研究,搭建了室内定位***实验室,以无人机作为被控对象进行算法研究。搭建室内定位***可以快速方便的进行科学研究,节省时间,缩短研究周期,避免了由于GPS信号弱或者接受信号不良导致由此导致的定位不准带来的问题,有 利于科研人员更专注于集群算法,编队协同算法,人工智能算法,智能控制算法,路径规 划算法,智能避障算法等的研究。
由于受限于目前民用无人机数据链硬件以及研究成本的原因,作为运动载体的无人 机无法接受数据刷新如此快且数据量如此大的数据。
发明内容
本发明的目的在于提供一种基于激光定位***的无人机导航定位方法,以解决上述 问题。
为实现上述目的,本发明采用以下技术方案:
一种基于激光定位***的无人机导航定位方法,所述激光定位***包括激光定位塔、 Hub集线器、AP控制器和定位件;若干激光定位塔均连接到Hub集线器,Hub集线器通 过无线路由器连接到AP控制器,AP控制器连接到定位件;无线路由器还连接到服务器; 激光定位塔、Hub集线器和AP控制器作为激光定位***的发射端,定位件作为激光定位 ***的接收端;包括以下步骤:
步骤1,无人机传感器健康检查,根据传感器输出的数据剔除坏点数据,具体包括激 光定位***数据健康检查和陀螺仪以及加速度计健康检查;
步骤2,通过激光加惯性导航***进行组合导航滤波,以激光定位***定位件输出的 无人机的姿态和位置数据作为量测信息,通过序贯kalman滤波的方式进行组合导航算法, 进而输出高频率、高精度的无人机自身位置和姿态数据;
步骤3,组合导航算法的一致性检查和组合导航算法健康检查,得到稳定的无人机姿 态和位置数据。
进一步的,激光定位塔用来标定过零信号,并实现光塔的编码,进而实现空间内安装 多个光塔分时扫描;Hub集线器通过自己的通信端口与其控制的各个激光定位塔连接,用 来控制各个激光定位塔的工作方式,实现所有光塔的同步;AP控制器用来连接Hub集线器,实现对整个定位空间所有Hub集线器以及激光定位塔的控制,实现配置整个工作组 网的工作模式以及状态;定位件将无人机在激光定位***空间内的局部坐标系下的位置和姿态信息传递给无人机飞控,飞控结合无人机上的惯导设备进行组合导航。
进一步的,步骤1中,激光定位***数据健康检查:
a)根据布置的激光定位空间以及激光定位光塔的扫描盲区进行位置超限判断,如果 位置数据超限不进入组合导航算法,只通过机载惯导进行状态递推;
b)激光定位***位置和姿态数据失联判断,如果100ms内无法接收到激光定位*** 数据,向上位机报错,并通过机载惯导进行状态递推;
c)根据实际无人机的最大飞行速度vmax,以及设置的激光定位***刷新频率并转换 为刷新时间间隔dt,计算最大的位置posmax=vmax*dt,如果激光定位***输出的相邻两针之间的位置变化超过最大位置posmax,那么改帧数据超限,该数据不进入组合导航滤波器,只进行一步状态预测。
进一步的,步骤1中,陀螺仪以及加速度计健康检查:
a)陀螺仪和加速度计数据是否校准,如果校准参数为空,那么陀螺和加计未校准,使用默认参数;
b)陀螺和加计数据是否超限,如果超限不使用该数据;
c)陀螺和加计数据是否失联,如果失联,上报上位机。
进一步的,步骤2中,组合导航滤波:
1)坐标系定义
选取激光定位***自身定义的坐标系为导航坐标系为n系;无人机重心为原点的前右 下坐标系为机体坐标系,为b系;
2)状态方程
选取的n系下的姿态,速度,位置,加速度计零偏,陀螺仪零偏作为组合导航算法的状态变量向量,共16维状态方程,即:
X=[q1 q2 q3 q4 vx vy vz px py pz gyro_biasx gyro_biasy gyro_biasz acc_biasx acc_biasy acc_biasz]
其中:
[q1 q2 q3 q4]为无人机姿态的四元素表示方法;
[vx vy vz]为n系下的三轴无人机速度;
[px py pz]为n系下的三轴无人机位置;
[gyro_biasx gyro_biasy gyro_biasz]为陀螺仪三轴零偏;
[acc_biasx acc_biasy acc_biasz]为加速度计三轴零偏。
3)序贯滤波进行状态估计。
进一步的,序贯滤波进行状态估计包括:
1)状态一步预测:
使用无人机自身的惯导设备进行一步状态预测,状态预测包括所有状态变量的一步预 测:
姿态四元素的更新:
其中
表示tm时刻的姿态变换四元素,是从tm-1时刻到tm时刻姿态四元素变化, Δθ是陀螺在时间段[tm-1,tm]内输出的角增量并且Δθ=|Δθ|,mems低精度陀螺仪一般采用 角增量输出采样的方式,只需要简单地将其乘以采样间隔时间Ts即可变换为角增量;
速度更新
对于低中速行驶的运载体,例如地速v<100m/s,忽略地球自转以及地球曲率的影响, 速度更新简化方程为
其中
位置更新
陀螺bias更新
加速度计bias更新
根据状态更新方程,求取状态转移矩阵记为F;
2)误差协方差矩阵更新
Pk/k-1=Fk/k-1Pk-1/k-1Fk/k-1+Gk-1Qk-1Gk-1+Qs
上式中
为状态jacobian矩阵和控制jacobian矩阵;
3)计算kalman滤波增益
4)状态更新
激光定位***获取得到的无人机的姿态和位置信息作为量测信息,根据序贯滤波第三 步计算的卡拉曼滤波增益对状态状态变量进行更新;
5)误差协方差矩阵更新以及状态反馈
Pk=(I-KkHk)Pk/k-1
完成一次滤波状态和协方差矩阵更新后,滤波器可以得到陀螺和加计的bias估计值, 在进行下一轮的状态更新之前可以对采样得到角增量和速度增量进行状态修正,从陀螺仪, 加速度计采用得到的角增量和速度增量减去陀螺仪和加速度计的零偏,以此来对IMU数 据进行修正。
进一步的,一致性检查:
Res称为信息,信息的期望
H为量测矩阵;
Pk-1为一步协方差预测矩阵;
Qk为过程噪声;
Rk为量测噪声。
正常情况下,下式成立
如果在进行组合导航算法过程中,出现Ratio>1的情况,那么该时刻的测量向量不应 该进入组合导航算法,组合导航算法只进行一步预测。
进一步的,协方差负定检查:
根据kalman滤波原理,协方差矩阵Pk/k-1是对称正定矩阵,对称正定矩阵表示如下
设A∈Rn×n,若A=AT,对任意0≠X∈Rn,都有XTAX>0,则称A为对称正定矩 阵;
如果协方差矩阵Pk/k-1出现负定,那么表示组合导航算法计算错误,需要重置协方差 矩阵。
与现有技术相比,本发明有以下技术效果:
本发明的Laser(激光)+INS(Inertial navigation system惯性导航***)进行组合导 航滤波,这种方法不仅可以实时输出无人机的位置和姿态信息,还可以得到很高的位置和 姿态精度,并且可以得到平滑精准的无人机速度,还可以降低无线数据链配置要求。
本发明可以实现在室内情况下对无人机运动速度的估计;
本发明可以降低对数据链路的要求;
本发明可以使研究人员更专注于上层算法科学以及工程研究。
附图说明
图1是激光定位***信息流图
图2是序贯kalman滤波流程图。
具体实施方式
以下结合附图对本发明进一步说明:
请参阅图1至图2,本发明分为三部分:第一部分,传感器健康检查;第二部分,laser+INS组合导航算法详细说明;第三部分,组合导航算法的健康检查。
传感器健康主要是根据传感器输出的数据剔除坏点数据,以便后续的组合导航算法 能稳定健康的运行。在整个无人机***中,包含如下传感器:
1)激光定位***传感器;
2)陀螺仪;
3)加速度计;
4)气压计。
步骤1,无人机传感器健康检查,根据传感器输出的数据剔除坏点数据,具体包括激 光定位***数据健康检查和陀螺仪以及加速度计健康检查;
步骤2,通过激光加惯性导航***进行组合导航滤波,以激光定位***定位件输出的 无人机的姿态和位置数据作为量测信息,通过序贯kalman滤波的方式进行组合导航算法, 进而输出高频率、高精度的无人机自身位置和姿态数据;
步骤3,组合导航算法的一致性检查和组合导航算法健康检查,得到稳定的无人机姿 态和位置数据。
步骤1中,激光定位***数据健康检查:
a)根据布置的激光定位空间以及激光定位光塔的扫描盲区进行位置超限判断,如果 位置数据超限不进入组合导航算法,只通过机载惯导进行状态递推;
b)激光定位***位置和姿态数据失联判断,如果100ms内无法接收到激光定位*** 数据,向上位机报错,并通过机载惯导进行状态递推;
c)根据实际无人机的最大飞行速度vmax,以及设置的激光定位***刷新频率并转换 为刷新时间间隔dt,计算最大的位置posmax=vmax*dt,如果激光定位***输出的相邻两针之间的位置变化超过最大位置posmax,那么改帧数据超限,该数据不进入组合导航滤波器,只进行一步状态预测。
步骤1中,陀螺仪以及加速度计健康检查:
a)陀螺仪和加速度计数据是否校准,如果校准参数为空,那么陀螺和加计未校准,使用默认参数;
b)陀螺和加计数据是否超限,如果超限不使用该数据;
c)陀螺和加计数据是否失联,如果失联,上报上位机。
步骤2中,组合导航滤波:
1)坐标系定义
选取激光定位***自身定义的坐标系为导航坐标系为n系;无人机重心为原点的前右 下坐标系为机体坐标系,为b系;
2)状态方程
选取的n系下的姿态,速度,位置,加速度计零偏,陀螺仪零偏作为组合导航算法的状态变量向量,共16维状态方程,即:
X=[q1 q2 q3 q4 vx vy vz px py pz gyro_biasx gyro_biasy gyro_biasz acc_biasx acc_biasy acc_biasz]
其中:
[q1 q2 q3 q4]为无人机姿态的四元素表示方法;
[vx vy vz]为n系下的三轴无人机速度;
[px py pz]为n系下的三轴无人机位置;
[gyro_biasx gyro_biasy gyro_biasz]为陀螺仪三轴零偏;
[acc_biasx acc_biasy acc_biasz]为加速度计三轴零偏。
3)序贯滤波进行状态估计。
序贯滤波进行状态估计包括:
1)状态一步预测:
使用无人机自身的惯导设备进行一步状态预测,状态预测包括所有状态变量的一步预 测:
姿态四元素的更新:
其中
表示tm时刻的姿态变换四元素,是从tm-1时刻到tm时刻姿态四元素变化, Δθ是陀螺在时间段[tm-1,tm]内输出的角增量并且Δθ=|Δθ|,mems低精度陀螺仪一般采用 角增量输出采样的方式,只需要简单地将其乘以采样间隔时间Ts即可变换为角增量;
速度更新
对于低中速行驶的运载体,例如地速v<100m/s,忽略地球自转以及地球曲率的影响, 速度更新简化方程为
其中
位置更新
陀螺bias更新
加速度计bias更新
根据状态更新方程,求取状态转移矩阵记为F;
2)误差协方差矩阵更新
Pk/k-1=Fk/k-1Pk-1/k-1Fk/k-1+Gk-1Qk-1Gk-1+Qs
上式中
为状态jacobian矩阵和控制jacobian矩阵;
3)计算kalman滤波增益
4)状态更新
激光定位***获取得到的无人机的姿态和位置信息作为量测信息,根据序贯滤波第三 步计算的卡拉曼滤波增益对状态状态变量进行更新;
5)误差协方差矩阵更新以及状态反馈
Pk=(I-KkHk)Pk/k-1
完成一次滤波状态和协方差矩阵更新后,滤波器可以得到陀螺和加计的bias估计值, 在进行下一轮的状态更新之前可以对采样得到角增量和速度增量进行状态修正,从陀螺仪, 加速度计采用得到的角增量和速度增量减去陀螺仪和加速度计的零偏,以此来对IMU数 据进行修正。
一致性检查:
Res称为信息,信息的期望
H为量测矩阵;
Pk-1为一步协方差预测矩阵;
Qk为过程噪声;
Rk为量测噪声。
正常情况下,下式成立
如果在进行组合导航算法过程中,出现Ratio>1的情况,那么该时刻的测量向量不应 该进入组合导航算法,组合导航算法只进行一步预测。
协方差负定检查:
根据kalman滤波原理,协方差矩阵Pk/k-1是对称正定矩阵,对称正定矩阵表示如下
设A∈Rn×n,若A=AT,对任意0≠X∈Rn,都有XTAX>0,则称A为对称正定矩 阵;
如果协方差矩阵Pk/k-1出现负定,那么表示组合导航算法计算错误,需要重置协方差 矩阵。
Claims (6)
1.一种基于激光定位***的无人机导航定位方法,其特征在于,所述激光定位***包括激光定位塔、Hub集线器、AP控制器和定位件;若干激光定位塔均连接到Hub集线器,Hub集线器通过无线路由器连接到AP控制器,AP控制器连接到定位件;无线路由器还连接到服务器;激光定位塔、Hub集线器和AP控制器作为激光定位***的发射端,定位件作为激光定位***的接收端;包括以下步骤:
步骤1,无人机传感器健康检查,根据传感器输出的数据剔除坏点数据,具体包括激光定位***数据健康检查和陀螺仪以及加速度计健康检查;
步骤2,通过激光加惯性导航***进行组合导航滤波,以激光定位***定位件输出的无人机的姿态和位置数据作为量测信息,通过序贯kalman滤波的方式进行组合导航算法,进而输出高频率、高精度的无人机自身位置和姿态数据;
步骤3,组合导航算法的一致性检查和组合导航算法健康检查,得到稳定的无人机姿态和位置数据;
激光定位塔用来标定过零信号,并实现光塔的编码,进而实现空间内安装多个光塔分时扫描;Hub集线器通过自己的通信端口与其控制的各个激光定位塔连接,用来控制各个激光定位塔的工作方式,实现所有光塔的同步;AP控制器用来连接Hub集线器,实现对整个定位空间所有Hub集线器以及激光定位塔的控制,实现配置整个工作组网的工作模式以及状态;定位件将无人机在激光定位***空间内的局部坐标系下的位置和姿态信息传递给无人机飞控,飞控结合无人机上的惯导设备进行组合导航;
步骤1中,激光定位***数据健康检查:
a)根据布置的激光定位空间以及激光定位光塔的扫描盲区进行位置超限判断,如果位置数据超限不进入组合导航算法,只通过机载惯导进行状态递推;
b)激光定位***位置和姿态数据失联判断,如果100ms内无法接收到激光定位***数据,向上位机报错,并通过机载惯导进行状态递推;
c)根据实际无人机的最大飞行速度vmax,以及设置的激光定位***刷新频率并转换为刷新时间间隔dt,计算最大的位置posmax=vmax*dt,如果激光定位***输出的相邻两帧之间的位置变化超过最大位置posmax,那么该帧数据超限,该数据不进入组合导航滤波器,只进行一步状态预测。
2.根据权利要求1所述的一种基于激光定位***的无人机导航定位方法,其特征在于,步骤1中,陀螺仪以及加速度计健康检查:
a)陀螺仪和加速度计数据是否校准,如果校准参数为空,那么陀螺和加速度计未校准,使用默认参数;
b)陀螺和加速度计数据是否超限,如果超限不使用该数据;
c)陀螺和加速度计数据是否失联,如果失联,上报上位机。
3.根据权利要求1所述的一种基于激光定位***的无人机导航定位方法,其特征在于,步骤2中,组合导航滤波:
1)坐标系定义
选取激光定位***自身定义的坐标系为导航坐标系为n系;无人机重心为原点的前右下坐标系为机体坐标系,为b系;
2)状态方程
选取的n系下的姿态,速度,位置,加速度计零偏,陀螺仪零偏作为组合导航算法的状态变量向量,共16维状态方程,即:
X=[q1 q2 q3 q4 vx vy vz px py pz
gyro_biasx gyro_biasy gyro_biasz acc_biasx acc_biasy acc_biasz]
其中:
[q1 q2 q3 q4]为无人机姿态的四元素表示方法;
[vx vy vz]为n系下的三轴无人机速度;
[px py pz]为n系下的三轴无人机位置;
[gyro_biasx gyro_biasy gyro_biasz]为陀螺仪三轴零偏;
[acc_biasx acc_biasy acc_biasz]为加速度计三轴零偏;
3)序贯滤波进行状态估计。
4.根据权利要求3所述的一种基于激光定位***的无人机导航定位方法,其特征在于,序贯滤波进行状态估计包括:
1)状态一步预测:
使用无人机自身的惯导设备进行一步状态预测,状态预测包括所有状态变量的一步预测:
姿态四元素的更新:
其中
表示tm时刻的姿态变换四元素,是从tm-1时刻到tm时刻姿态四元素变化,Δθ是陀螺在时间段[tm-1,tm]内输出的角增量并且Δθ=|Δθ|,mems低精度陀螺仪采用角增量输出采样的方式,将其乘以采样间隔时间Ts即可变换为角增量;
速度更新
对于低中速行驶的运载体,低速v<100m/s,忽略地球自转以及地球曲率的影响,速度更新简化方程为
其中
位置更新
陀螺bias更新
加速度计bias更新
根据状态更新方程,求取状态转移矩阵记为F;
2)误差协方差矩阵更新
Pk/k-1=Fk/k-1Pk-1/k-1Fk/k-1+Gk-1Qk-1Gk-1+Qs
上式中
为状态jacobian矩阵和控制jacobian矩阵;
3)计算kalman滤波增益
4)状态更新
激光定位***获取得到的无人机的姿态和位置信息作为量测信息,根据序贯滤波第三步计算的卡拉曼滤波增益对状态变量进行更新;
5)误差协方差矩阵更新以及状态反馈
Pk=(I-KkHk)Pk/k-1
完成一次滤波状态和协方差矩阵更新后,滤波器得到陀螺和加计的bias估计值,在进行下一轮的状态更新之前对采样得到角增量和速度增量进行状态修正,从陀螺仪,加速度计采用得到的角增量和速度增量减去陀螺仪和加速度计的零偏,以此来对IMU数据进行修正。
6.根据权利要求1所述的一种基于激光定位***的无人机导航定位方法,其特征在于,协方差负定检查:
根据kalman滤波原理,协方差矩阵Pk/k-1是对称正定矩阵,对称正定矩阵表示如下
设A∈Rn×n,若A=AT,对任意0≠X∈Rn,都有XTAX>0,则称A为对称正定矩阵;
如果协方差矩阵Pk/k-1出现负定,那么表示组合导航算法计算错误,需要重置协方差矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010426152.3A CN111486841B (zh) | 2020-05-19 | 2020-05-19 | 一种基于激光定位***的无人机导航定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010426152.3A CN111486841B (zh) | 2020-05-19 | 2020-05-19 | 一种基于激光定位***的无人机导航定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111486841A CN111486841A (zh) | 2020-08-04 |
CN111486841B true CN111486841B (zh) | 2022-04-05 |
Family
ID=71792272
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010426152.3A Active CN111486841B (zh) | 2020-05-19 | 2020-05-19 | 一种基于激光定位***的无人机导航定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111486841B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112629521A (zh) * | 2020-12-13 | 2021-04-09 | 西北工业大学 | 一种旋翼飞行器双冗余组合的导航***建模方法 |
CN112683274A (zh) * | 2020-12-22 | 2021-04-20 | 西安因诺航空科技有限公司 | 一种基于无迹卡尔曼滤波的无人机组合导航方法和*** |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106226780A (zh) * | 2016-07-26 | 2016-12-14 | 南京航空航天大学 | 基于激光扫描雷达的多旋翼室内定位***及实现方法 |
CN107144281A (zh) * | 2017-06-30 | 2017-09-08 | 飞智控(天津)科技有限公司 | 基于合作目标和单目视觉的无人机室内定位***及定位方法 |
CN109709801A (zh) * | 2018-12-11 | 2019-05-03 | 智灵飞(北京)科技有限公司 | 一种基于激光雷达的室内无人机定位***及方法 |
CN109931926A (zh) * | 2019-04-04 | 2019-06-25 | 山东智翼航空科技有限公司 | 一种基于站心坐标系的小型无人机无缝自主式导航算法 |
CN110187695A (zh) * | 2019-04-19 | 2019-08-30 | 北京航空航天大学 | 一种无人机协同控制验证平台 |
CN110887486A (zh) * | 2019-10-18 | 2020-03-17 | 南京航空航天大学 | 一种基于激光线辅助的无人机视觉导航定位方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9933521B2 (en) * | 2014-04-14 | 2018-04-03 | The Boeing Company | Aerial positioning systems and methods |
-
2020
- 2020-05-19 CN CN202010426152.3A patent/CN111486841B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106226780A (zh) * | 2016-07-26 | 2016-12-14 | 南京航空航天大学 | 基于激光扫描雷达的多旋翼室内定位***及实现方法 |
CN107144281A (zh) * | 2017-06-30 | 2017-09-08 | 飞智控(天津)科技有限公司 | 基于合作目标和单目视觉的无人机室内定位***及定位方法 |
CN109709801A (zh) * | 2018-12-11 | 2019-05-03 | 智灵飞(北京)科技有限公司 | 一种基于激光雷达的室内无人机定位***及方法 |
CN109931926A (zh) * | 2019-04-04 | 2019-06-25 | 山东智翼航空科技有限公司 | 一种基于站心坐标系的小型无人机无缝自主式导航算法 |
CN110187695A (zh) * | 2019-04-19 | 2019-08-30 | 北京航空航天大学 | 一种无人机协同控制验证平台 |
CN110887486A (zh) * | 2019-10-18 | 2020-03-17 | 南京航空航天大学 | 一种基于激光线辅助的无人机视觉导航定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111486841A (zh) | 2020-08-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111426318B (zh) | 基于四元数-扩展卡尔曼滤波的低成本ahrs航向角补偿方法 | |
Fan et al. | Data fusion for indoor mobile robot positioning based on tightly coupled INS/UWB | |
CN110926460B (zh) | 一种基于IMU的uwb定位异常值处理方法 | |
CN102692223B (zh) | 用于wsn/ins组合导航的多级非线性滤波器的控制方法 | |
US20220326720A1 (en) | Method and system for hovering control of unmanned aerial vehicle in tunnel | |
CN111486841B (zh) | 一种基于激光定位***的无人机导航定位方法 | |
CN102508493B (zh) | 一种小型无人飞行器飞行控制方法 | |
CN102809377A (zh) | 飞行器惯性/气动模型组合导航方法 | |
CN110377056B (zh) | 无人机航向角初值选取方法及无人机 | |
CN102607562A (zh) | 基于载体飞行模态判别的微惯性参数自适应姿态确定方法 | |
CN202177381U (zh) | 运动姿态数据获取装置与人体运动姿态追踪*** | |
CN103712598A (zh) | 一种小型无人机姿态确定***与确定方法 | |
CN114323033A (zh) | 基于车道线和特征点的定位方法、设备及自动驾驶车辆 | |
CN111238469A (zh) | 一种基于惯性/数据链的无人机编队相对导航方法 | |
CN114111802A (zh) | 一种行人航迹推算辅助uwb的定位方法 | |
Gao et al. | An integrated land vehicle navigation system based on context awareness | |
CN110595434B (zh) | 基于mems传感器的四元数融合姿态估计方法 | |
Yang et al. | Fuzzy adaptive Kalman filter for indoor mobile target positioning with INS/WSN integrated method | |
CN114440895A (zh) | 基于因子图的气压辅助Wi-Fi/PDR室内定位方法 | |
CN114915913A (zh) | 一种基于滑窗因子图的uwb-imu组合室内定位方法 | |
CN113465596B (zh) | 一种基于多传感器融合的四旋翼无人机定位方法 | |
CN112254723B (zh) | 基于自适应ekf算法的小型无人机marg航姿估计方法 | |
CN112284388B (zh) | 一种无人机多源信息融合导航方法 | |
CN102353375A (zh) | 运动姿态数据的动态参数调整方法与设备 | |
CN113297506A (zh) | 一种基于社交位置细胞/网格细胞的类脑相对导航方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |