CN110785722A - 对移动平台的参数优化方法、装置及控制设备、飞行器 - Google Patents
对移动平台的参数优化方法、装置及控制设备、飞行器 Download PDFInfo
- Publication number
- CN110785722A CN110785722A CN201880038852.6A CN201880038852A CN110785722A CN 110785722 A CN110785722 A CN 110785722A CN 201880038852 A CN201880038852 A CN 201880038852A CN 110785722 A CN110785722 A CN 110785722A
- Authority
- CN
- China
- Prior art keywords
- parameter
- state
- mobile platform
- preset
- speed
- 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.)
- Pending
Links
- 238000005457 optimization Methods 0.000 title claims abstract description 121
- 238000000034 method Methods 0.000 title claims abstract description 53
- 230000004438 eyesight Effects 0.000 claims abstract description 64
- 238000004364 calculation method Methods 0.000 claims abstract description 32
- 230000000007 visual effect Effects 0.000 claims description 92
- 238000013507 mapping Methods 0.000 claims description 44
- 230000016776 visual perception Effects 0.000 claims description 39
- 230000001133 acceleration Effects 0.000 claims description 25
- 239000011159 matrix material Substances 0.000 claims description 24
- 230000008447 perception Effects 0.000 claims description 16
- 230000001953 sensory effect Effects 0.000 claims description 16
- 230000009466 transformation Effects 0.000 claims description 16
- 238000005259 measurement Methods 0.000 claims description 12
- 238000001914 filtration Methods 0.000 claims description 9
- 238000012545 processing Methods 0.000 claims description 9
- 238000004891 communication Methods 0.000 claims description 7
- 238000004422 calculation algorithm Methods 0.000 description 33
- 230000003068 static effect Effects 0.000 description 16
- 230000015654 memory Effects 0.000 description 14
- 230000005484 gravity Effects 0.000 description 9
- 230000008569 process Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 8
- 238000012937 correction Methods 0.000 description 7
- 230000008878 coupling Effects 0.000 description 6
- 238000010168 coupling process Methods 0.000 description 6
- 238000005859 coupling reaction Methods 0.000 description 6
- 239000013598 vector Substances 0.000 description 5
- 238000011160 research Methods 0.000 description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 230000004807 localization Effects 0.000 description 2
- 238000013519 translation Methods 0.000 description 2
- 238000004590 computer program Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010790 dilution Methods 0.000 description 1
- 239000012895 dilution Substances 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000005283 ground state Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000000977 initiatory effect Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000005389 magnetism Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000000284 resting effect Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C27/00—Rotorcraft; Rotors peculiar thereto
- B64C27/04—Helicopters
- B64C27/08—Helicopters with two or more rotors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Navigation (AREA)
Abstract
本发明实施例提供一种对移动平台的参数优化方法、装置及控制设备、飞行器,其中的方法包括:确定移动平台当前的上电状态(S201);获取移动平台在上电状态下采集的传感数据(S202);若根据传感数据确定移动平台在上电状态下为稳定状态,则对上电状态所对应的移动平台的观测参数进行优化,以修正观测参数(S203);其中,观测参数是根据姿态传感器和/或视觉传感器的感测数据计算得到的,移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数。采用本发明实施例,可以较好地保证观测参数优化的准确性和及时性,方便后续更加安全地对移动平台进行控制。
Description
技术领域
本发明实施例涉及电子技术领域,尤其涉及一种对移动平台的参数优化方法、装置及飞行器。
背景技术
随着电子技术、自动化技术的不断发展和完善,各类能够自动感知周围环境而进行智能运动控制的移动平台层出不穷,这些移动平台例如为飞行器、智能机器人、自动驾驶汽车等等。
为了实现智能运动控制,在这些移动平台上会设置一些传感器,经由这些传感器来感测移动平台周围的环境以及移动平台自身的数据,以这些数据为依据来完成移动平台的运动控制。例如会设置基于摄像头等装置的视觉传感器、包括加速度计、陀螺仪的IMU(Inertial measurement unit,惯性测量单元)、GPS(Global Positioning System,全球定位***)模块等能够进行定位的位置传感器,基于这些传感器感测到的环境图像、移动平台的姿态,速度等参数、移动平台的位置等来实现对移动平台的控制。
目前,无人机、自动驾驶汽车等移动平台主要依赖于GPS的定位方式,来对移动平台进行定位,在准确定位的基础上,实现安全控制。为了进一步保证安全性,在实现是还可以引入了依靠计算机视觉算法的视觉感知***,视觉感知***可以提供速度、位置等信息的观测,从而实现稳定悬停以及运动规划等控制处理。而如何处理基于视觉感知***而计算得到的相关参数,以便于更好地对各类移动平台进行自动化、智能化控制成为研究的热点问题。
发明内容
本发明实施例提供了一种对移动平台的参数优化方法、装置及飞行器,可有针对性地对不同的观测参数进行优化。
一方面,本发明实施例提供了一种对移动平台的参数优化方法,所述移动平台上设置有视觉感知***,所述视觉感知***包括姿态传感器和视觉传感器,所述方法包括:确定所述移动平台当前的上电状态;获取所述移动平台在所述上电状态下采集的传感数据;
若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;
其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数。
另一方面,本发明实施例提供了一种对移动平台的参数优化装置,所述移动平台上设置有视觉感知***,所述视觉感知***包括姿态传感器和视觉传感器,所述装置包括:确定模块,用于确定所述移动平台当前的上电状态;获取模块,用于获取所述移动平台在所述上电状态下采集的传感数据;优化模块,用于若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数。
另一方面,本发明实施例提供了一种控制设备,所述控制设备用于对移动平台进行参数优化,所述控制设备与移动平台的视觉感知***相连,所述视觉感知***包括姿态传感器和视觉传感器,所述控制设备包括:通信接口和处理器;所述通信接口,用于与视觉感知***相连;所述处理器,用于获取所述移动平台在所述上电状态下采集的传感数据;若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数。
另一方面,本发明实施例提供了一种飞行器,所述飞行器包括:视觉感知***、控制器、动力组件,其中,所述视觉感知***包括姿态传感器和视觉传感器;
所述控制器,用于根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到观测参数,并且用于确定所述移动平台当前的上电状态;获取所述移动平台在所述上电状态下采集的传感数据;若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数,并用于基于修正后的观测参数对所述动力组件进行控制,以控制所述飞行器运动。
本发明实施例能够对移动平台定义不同的上电状态,并在不同的上电状态下有针对性地对不同的基于视觉感知***的感测数据得到的观测数据进行优化,可以较好地保证观测参数优化的准确性和及时性,方便后续更加安全地对移动平台进行控制。
附图说明
图1是本发明实施例的一种飞行器的结构示意图;
图2是本发明实施例的一种对移动平台的参数优化方法的流程示意图;
图3a是本发明实施例的基于视觉定位算法计算相关感测数据的示意图;
图3b是本发明实施例的基于视觉定位算法计算相关感测数据的示意图;
图4是本发明实施例的一种对移动平台的参数优化装置的结构示意图;
图5是本发明实施例的一种控制设备的结构示意图。
具体实施方式
在本发明实施例中,移动平台的运动主要是结合位置传感器的定位数据和视觉感知***的观测数据,来对移动平台进行自动化控制。位置传感器例如可以是常见的GPS定位传感器,也可以为能够定位经纬度坐标的其他传感器,例如北斗定位传感器、伽利略定位传感器等等。而本发明实施例的视觉感知***则主要包括姿态传感器和视觉传感器,所述姿态传感器包括加速度计和陀螺仪,例如可以为一个IMU模块,所述视觉传感器则主要基于双目摄像头构建得到。
图1是以飞行器为例示意了本发明实施例的移动平台的结构示意图,其中包括IMU101和双目视觉传感器102,IMU101和双目视觉传感器102的感测数据可以发送给飞行器的飞行控制器103,由飞行控制器103进行计算以得到能够用来控制飞行器飞行的数据,例如基于视觉定位算法对IMU101和双目视觉传感器102的感测数据进行计算得到观测参数,如用于定位的数据。在其他实施例中,可以根据用户的需求以及所处环境的不同,可以在飞行器、智能机器人、自动驾驶汽车等移动平台构建不同结构以及安装方式,以达到对移动平台更为稳定、安全的控制目的。
在本发明实施例中,请参见图2,是本发明实施例的一种对移动平台的参数优化方法的流程示意图,该优化方法可以由一个单独的控制设备来实现,该控制设备一方面能够与视觉感知***相连,以便于对视觉感知***的相关数据进行计算优化,另一方面能够将最终优化得到的数据输出,以便于更好地对移动平台进行安全控制。当然,所述优化方法也可以由移动平台中的某个功能模块来实现,通过该功能模块来获取视觉感知***的相关数据,然后直接对移动平台进行安全控制,例如,对于飞行器而言,可以是该飞行器的飞行控制器来执行,对于自动驾驶汽车而言,可以是由该自动驾驶汽车的中央控制器来执行。
可以根据移动平台的感测数据和/或移动平台上的部分或者全部的功能部件的传感数据来在S201中确定移动平台当前的上电状态,当然,移动平台的上电状态还可以通过其他方式来确定。在一个实施例中,还可以根据设置的对移动平台的控制模式来确定移动平台的上电状态,例如飞行器可以被用户通过遥控器设置的方式设置为按照预设航线自动飞行的飞行模式、停止飞行的悬停模式、降落后的待机模式等等,这些模式在一个实施例中可以基于用户在遥控器上的一次或多次用户操作来实现。在本发明实施例中,可以为移动平台至少定义两个上电状态,从而可以基于不同的上电状态下的安全控制需求,有针对性地对视觉感知***对应的观测参数进行优化。在本发明实施例中,上电状态可以包括但不限于:运动状态、悬停状态、静置状态。其中,当移动平台为飞行器时,运动状态可以为飞行状态,且悬停状态可以是飞行器悬停于空中的特有状态;静置状态可以被描述为移动平台已经上电后但并未启动电机,而移动平台被放置在水平地面等场地上时的状态,例如,飞行器被上电后,放在地面上随时可以接收飞行指令时的状态。
可以在确定移动平台当前的上电状态的同时或者之后,在S202中获取移动平台在上电状态下采集的传感数据。传感数据主要是指在移动平台上的传感器输出的数据来确定的,移动平台的传感器例如可以包括位置传感器、上述的姿态传感器如IMU,视觉传感器等等。在不同的上电状态下,所需的传感数据不相同。在一个实施例中,在上电状态为运动状态下,所需的传感数据包括:位置传感器的状态参数,状态参数具体可以是速度状态参数、高度状态参数、信号强度参数、速度精度估计指标中的任意一个或者多个。在上电状态为悬停状态下,传感数据包括:基于姿态传感器采集的感测数据计算得到的数据,姿态传感器包括加速度计和陀螺仪,具体的,传感数据可以包括:基于加速度计的感测数据计算的加速度、基于陀螺仪的感测数据计算的角度、基于加速度计的感测数据计算得到的速度中的任意一个或者多个数据。在上电状态包括静置状态时,传感数据包括:姿态传感器中的陀螺仪的测量值,具体的,传感器数据可以包括:陀螺仪的零轴偏差。
在获取到上电状态下的传感数据后,在S203中若根据传感数据确定移动平台在上电状态下为稳定状态,则对上电状态所对应的移动平台的观测参数进行优化,以修正观测参数。
由于移动平台已经处于相应的上电状态了,因此,此时需要优化的观测参数为移动平台在当前上电状态下的观测参数,观测参数是根据姿态传感器和/或视觉传感器的感测数据计算得到。在一个实施例中,视觉感知***对应的观测参数可以是基于视觉定位算法对姿态传感器(如惯性测量单元)和/或视觉传感器的感测数据进行计算得到。视觉定位算法例如可以是VO(Visual Odometry,视觉里程计)算法或VIO(Visual-InertialOdometry,视觉惯导里程计)算法。
基于视觉与惯导相结合的视觉感知***最少只需要一个相机(如摄像头)和一个IMU就可以完成移动平台的定位功能,这样可以使移动平台在室内等无GPS或GPS较弱的情况下感知自己相对于环境的位置,进而完成导航等上层应用,扩展了移动平台的使用范围。可以按照是否把视觉传感器感测的图像的图像特征加入到状态向量,将视觉定位算法分为松耦合(loosely-coupled)和紧耦合(tightly-coupled)。
其中,松耦合未把图像特征加入到状态向量中,而是把图像作为一个黑盒子,基于图像独立计算出相机(如视觉传感器)的位姿(位置与姿态),然后才和IMU信息进行融合,具体如图3a所示。所述的松耦合算法可理解为VO算法。
紧耦合是把图像特征加入到状态向量中,并使用两个传感器的原始数据共同估计一组向量,具体如图3b所示,其充分使用了姿态传感器(如惯性测量单元)和视觉传感器的感测数据,能达到比较高的定位精度。所述的紧耦合算法可理解为VIO算法。
可以理解,在松耦合或紧耦合算法中,也可以融入其它传感器的数据,如GPS等位置传感器,具体可以根据需要进行设定。
在本发明实施例,可以选择使用IMU+视觉传感器,使用6-DoF(Degrees offreedom,六自由度)的VIO算法来计算得到移动平台的观测参数。其中,所述的六自由度是指x轴、y轴、z轴的旋转以及x轴、y轴、z轴方向上的平移。而计算得到的观测参数则可以包括:视觉速度数据、第一角度参数和第二角度参数、姿态传感器中的陀螺仪参数。其中,第一角度参数包括:视觉感知***预估的北向与真实北向之间的第一夹角,第一夹角是对位置传感器和视觉传感器采集的感测数据进行计算得到的;第二角度参数包括:视觉感知***预估的水平面与真实水平面之间的第二夹角,第二夹角是对姿态传感器采集的感测数据进行计算得到的。陀螺仪参数包括:姿态传感器中陀螺仪的零轴偏差。
在得到了上述的观测参数后,且根据传感数据确定移动平台在上电状态下为稳定状态,即可在所述S203中对观测参数进行优化,以控制移动平台。可以基于对观测参数优化后得到的相关参数,对移动平台当前的位置、姿态等进行修正,以便于得到更为准确的相关视觉定位参数,最终依据这些更为准确的视觉定位参数对移动平台进行安全控制。例如,可以控制如图1所述的无人机能够更稳定地飞行、更稳定地悬停。在一个实施例中,对观测参数的优化可以基于卡尔曼滤波器对移动平台的观测参数进行优化。
另外,在优化过程中,针对一些上电状态,例如后续提到的运动状态,可以利用一些参考参数来对观测参数进行优化。具体的,本发明实施例的所述方法包括:获取移动平台在上电状态下的观测参数对应的参考参数;对观测参数进行优化,包括:对参考参数和观测参数之间的差异数据进行优化,得到观测参数的观测补偿数据。所述的参考参数例如可以是基于GPS等位置传感器感测到的相对准确的参数,基于这些相对准确的数据来对基于VIO等算法计算得到的观测参数进行优化。具体的优化方式可参考下述实施例中,对视觉速度数据和第一角度参数数据等观测参数的优化。
在本发明实施例中,可以在对观测参数进行优化之前,先根据传感数据确定移动平台在上电状态下是否为稳定状态。由此,可以定义一些条件,在传感数据满足条件时,才认为移动平台在当前的上电状态下为稳定状态,且可以开始对观测参数进行优化。基于定义的这些条件来触发优化可以在一定程度上保证不会将本来较优的观测参数进行了错误的优化,或保证不会对观测参数进行不必要的优化。在一个实施例中,在执行S203之前,所述方法可以包括:检测所述传感数据是否满足预设优化条件;若传感数据满足预设优化条件,则确定移动平台在上电状态下为稳定状态,以便于执行所述S203中对观测参数进行优化的步骤,以控制移动平台的步骤。
下面基于移动平台的不同上电状态,且以移动平台为飞行器为例,对移动平台的相应上电状态下的相应观测参数的优化进行详细说明:
经研究发现,对于单目的VIO***,比如一些飞行器是在飞行器的左右侧面仅设置了单目视觉传感器,或是在高空中双目视觉传感器的图像之间基本没有差别,也退化为单目视觉传感器的情况下,基于VIO算法计算得到的观测参数的准确性无法保证。并且,在飞行器匀速运动的时候,姿态传感器IMU中的加速度计基本没有观测(因为加速度计测量的是加速度),整个算法退化为SfM(Structure from motion,运动推断结构算法),基于VIO算法计算得到的观测参数的准确性也是无法保证的。例如,经过测试发现,在飞行器以真实速度为10m/s匀速运动时,基于VIO算法计算得到的观测参数(即观测得到的速度)可能只有真实速度的0.92倍,即9.2m/s。也就是说,基于上述情况,可以选择在运动状态下对观测参数进行优化,以尽量得到更优的观测参数。
在一个实施例中,定义了运动状态作为移动平台上电状态之一,移动平台上还设置了上述提及的GPS、北斗、伽利略等位置传感器。处于运动状态下,可以选择采用基于位置传感器的观测值来修正视觉感知***的观测参数,即所采用的观测值可以对应于上述提及的参考参数,基于位置传感器对应的参考参数与观测参数之间的差异数据进行优化,从而得到观测参数的观测补偿数据。基于此,需要保证位置传感器的观测值为相对较为准确的值,在此情况下需要对位置传感器的数据进行相应的评估,判定其是否满足预设优化条件。因此,传感数据包括获取的位置传感器的状态参数,也即通过位置传感器的状态参数来判断位置传感器的感测信号(如定位信号)是否较优,并在感测信号较优的情况下确定传感数据满足预设优化条件。具体的,在运动状态下,位置传感器的状态参数包括:姿态参数、信号强度参数和速度精度估计指标中的一种或多种,对应的,传感数据满足预设优化条件包括:姿态参数满足预设姿态条件、信号强度参数所指示的信号强度大于预设的强度阈值、速度精度估计指标小于预设的指标阈值中的任意一种或多种。只要在运动状态下选择的这些传感数据满足预设优化条件,则可以认为移动平台在运动状态下为稳定状态。
在一个实施例中,姿态参数包括:速度状态参数和/或高度状态参数;对应的,姿态参数满足姿态条件包括:速度状态参数所指示的速度大于预设的速度阈值,和/或高度状态参数所指示的高度大于预设的高度阈值。在一个实施例中,具体可以判断基于位置传感器的感测数据计算得到的水平速度的模长是否大于3m/s(或者其他速度阈值),以及高度是否大于12米(或者其他高度阈值,该高度阈值是根据视觉传感器中的双摄像头的参数确定的,具体可以基于双摄像头的分辨率、焦距以及双目间距)来确定是否满足预设优化条件。其中,速度越大GPS等位置传感器的观测质量越高,可信度也越高,而同时高空高速运行也是VIO算法容易出问题的时段,因此在速度大于3m/s、高度大于12米时,可以认为位置传感器的动态性能较好,基于位置传感器确定的参考参数,能够最终对VIO算法计算得到的观测参数进行优化。同时,基于GPS等位置传感器的姿态参数,也可以确定飞行器等移动平台处于运动状态。
在一个实施例中,还可以参考GPS等位置传感器的信号强度,如果信号强度大于预设的强度阈值例如3,则也可以认为基于GPS等位置传感器得到的观测值较为准确,可以用来对VIO算法计算得到的观测参数进行优化。另外,在参考位置传感器的信号强度时,还可以进一步参考GPS的DOP(Dilution of precision,精度因子)指标,以此来综合评估位置传感器的观测值是否较优。
在一个实施例中,还可以参考GPS等位置传感器的速度精度估计指标,如果该速度精度估计指标小于预设的指标阈值例如20,则可以认为基于GPS等位置传感器得到的观测值较为准确,可以用来对VIO算法计算得到的观测参数进行优化。
在一个实施例中,在运动状态下对观测参数进行优化可以是对观测参数包括的视觉速度数据进行优化。也就是说,在运动状态下,对观测参数进行优化,包括:对运动状态下对应的移动平台的视觉速度数据进行优化;其中,视觉速度数据是对姿态传感器和视觉传感器采集的感测数据进行计算得到的。基于VIO算法计算得到的视觉速度数据Vvio的具体计算方式可参考现有的方式。
在本发明实施例中,对视觉速度数据的优化可以是调用预置的卡尔曼滤波器进行的,主要思路是优化需要修正的速度的尺度残差,并利用修正后的速度的尺度残差对观测参数(即视觉速度数据Vvio)进行补偿。在此思路中所使用的残差公式如下:
其中,两个雅克比矩阵利用如下公式表示:
上述公式1和公式2中,VGPS表示基于GPS的感测数据计算得到的速度,可以称之为定位速度参数,VGPS,x和VGPS,y分别表示VGPS在GPS传感器所在的坐标系下的x轴和y轴上分解的速度,也可以理解为一种定位速度参数,该定位速度参数可以认为是上述提及的位置传感器的参考参数,利用该参考参数(定位速度参数)来对观测参数(视觉速度数据)进行优化。同理,Vvio,x和Vvio,y分别表示Vvio在视觉传感器所对应的坐标系(VIO坐标系)下的x轴和y轴上分解的速度,δsx和δsy是需要卡尔曼滤波器优化得到的数据,δsx和δsy分别可以表示为对Vvio在视觉传感器所对应的坐标系下的x轴和y轴上的速度进行补偿的速度补偿量。得到速度的尺度残差r和两个雅克比矩阵的表达式后,基于卡尔曼滤波器来优化得到速度补偿量,以基于该速度补偿量对Vvio,x和Vvio,y分别进行补偿优化,最终完成对Vvio的优化。
在一个实施例中,可以采用非线性的误差状态的扩展卡尔曼滤波器(No-linearerror state EKF(Extended Kalman Filter,扩展卡尔曼滤波器))优化得到速度补偿量。具体的,对于上述提及的公式1,具体是将Jx和Jy、以及作为No-linear error state EKF的输入数据,优化得到的输出数据即为δsx和δsy,在得到速度补偿量δsx和δsy后,在基于VIO算法已经得到的Vvio,x和Vvio,y基础上,加上相应的速度补偿量,即完成了对视觉速度数据的优化。
在一个实施例中,在运动状态下对观测参数进行优化主要还可以是对观测参数包括的第一角度参数进行优化,也就是说,在运动状态下,对观测参数进行优化,包括:对运动状态下对应的移动平台的第一角度参数进行优化;其中,第一角度参数包括:视觉感知***预估的北向与真实北向之间的第一夹角,第一夹角是对位置传感器和视觉传感器采集的感测数据进行计算得到的。例如,第一角度参数具体可以包括:基于位置传感器和视觉传感器采集的感测数据计算得到视觉感知***预估的北向与真实北向(如根据GPS的感测数据确定的北向)之间的偏差(如偏航yaw角偏差)。基于位置传感器和视觉传感器采集的感测数据计算得到第一角度参数可以采用现有的计算方式计算得到。
在本发明实施例中,对第一角度参数的优化也可以是调用预置的卡尔曼滤波器进行的,在优化过程中采用的思路可以包括:修正视觉感知***预估的北向与真实北向之间的偏差,然后将GPS等位置传感器所在的坐标系下的速度观测转到VIO坐标系下求残差修正速度,完成修正。其中,由于IMU所在的坐标系会与GPS所在的坐标系对齐,则间接修正了VIO坐标系与IMU所在的坐标系之间的偏差。在此思路下的残差公式如下:
其中,两个雅克比矩阵利用如下公式表示:
其中,可以定义为:二维GPS坐标系按顺时针转动到VIO坐标系的角度。为卡尔曼滤波器需要优化输出的值,表示第一角度参数的角度补偿量。同样,在得到残差r和雅克比矩阵的表达式后,即可具体调用预设的卡尔曼滤波器来优化得到相应的角度补偿量,以对基于视觉感知***所对应的第一角度参数例如yaw角进行补偿优化。在公式3中的δV是指基于VIO计算得到的在VIO坐标系下的速度的速度补偿量,在公式4中的vx和vy则表示为基于VIO计算得到的速度在VIO坐标系的x轴和y轴上的分解速度。
作为No-linear error state EKF的输入数据,优化得到的输出数据包括在得到第一角度参数的角度补偿量后,在基于VIO算法已经得到的基础上,加上该第一角度参数的角度补偿量,即完成了对第一角度参数的优化。
在一个实施例中,姿态传感器包括陀螺仪,在对第一角度参数进行优化之前,还可以进一步检测陀螺仪的当前读数ω与陀螺仪当前的零轴偏差之间的差异是否满足预设条件,例如,可以检测陀螺仪的当前读数ω与陀螺仪当前的零轴偏差之间的模长是否小于预设阈值,若该模长小于预设阈值,则说明移动平台当前的姿态较为平稳,且可以认为其未绕偏航轴发生转动,那么此时可以对第一角度参数例如yaw角进行补偿优化。
通过上述的实施例可以看出,一方面,确定出了观测参数中视觉速度参数和第一角度参数容易出现误差的运动状态,并在运动状态下对基于VIO算法计算得到观测参数中的视觉速度数据、第一角度参数进行优化,使得观测参数的优化更具针对性;另一方面也对在观测参数优化所需的参考参数进行了筛选,只有在满足条件时位置传感器的感测数据才会被利用来确定参考参数,这样也较好地保证了对观测参数进行优化的准确性。
另外,在一个实施例中,是对Vvio进行优化还是对第一角度参数进行优化可以根据需要进行选择。可以判断定位速度参数与视觉速度数据之间的差异是否满足预设的差异条件;若是,则触发执行对运动状态下对应的移动平台的视觉速度数据进行优化,在优化时将所述定位速度参数进一步作为参考参数参与对视觉速度数据的优化。如果此时在对第一角度参数进行优化,则可以取消对第一角度参数的优化转而进行对视觉速度数据的优化。也就是说,对视觉速度数据进行优化的优先级高,但是并不是一直修正,当检测到尺度差异大于某一阈值VH,如:定位速度参数的模长与视觉速度数据的模长之间的差值大于预设的阈值||VGPS||-||VVIO||>VH,则可以打断对第一角度参数的优化而对视觉速度数据进行Vvio优化。
另外,在一个实施例中,为了保证在计算时使用了准确的VGPS,避免由于GPS等位置传感器和姿态传感器IMU安装位置不同而带来的杆臂误差,可将计算得到的GPS等位置传感器的速度转到IMU端上,将转换后的速度作为位置传感器的观测值即VGPS。也就是说,传感数据中包括的定位速度参数是根据初始定位速度参数计算得到的,初始定位速度参数是根据位置传感器感测到的定位数据计算得到。其中,根据初始定位速度参数计算得到定位速度参数,包括:根据映射参数对初始定位速度参数进行映射计算,得到位置传感器在姿态传感器所在坐标系下的映射速度参数;将映射速度参数作为定位速度参数。在一个实施例中,根据映射参数对初始定位速度参数进行映射计算,得到位置传感器在姿态传感器所在坐标系下的映射速度参数,包括:获取姿态传感器感测得到的角速度参数,并获取姿态传感器与位置传感器之间的坐标系旋转变换矩阵;根据角速度参数、坐标系旋转变换矩阵、以及初始定位速度参数,计算得到位置传感器在姿态传感器所在坐标系下的映射速度参数。在一个实施例中,具体的转化公式如下:
VIMU=VGPS-Rwi[mgyro]×TIG 公式5;
其中,VIMU表示转化到IMU端的速度,对应于上述的VGPS,VGPS是原始的GPS端的速度即初始定位速度参数,Rwi是IMU所在的坐标系到世界坐标系的旋转变换矩阵,mgyro为陀螺测量的角速度,[]×是叉乘的矩阵表达,TIG是指在IMU坐标系下,GPS指向IMU的平移向量。
进一步地,在本发明实施例中还可以对GPS等位置传感器和IMU因为时间不同步带来的误差进行处理。具体可以通过时间戳来同步,初始定位速度参数是在获取到姿态传感器采集的感测数据的预设时长阈值后、对位置传感器感测到的定位数据进行计算得到的。例如,GPS的观测一般是500ms,所以IMU的值出来后,需要大概500ms(预设时长阈值)再与GPS速度比较。
在一个实施例中,在VIO计算过程中,可能会引入一些观测较差或是匹配错误的特征点,但这些特征点并不能完全筛除,且会使VIO计算得到的姿态逐渐错误,引起VIO坐标系与IMU的基准坐标系发生了偏移,由此计算出来的相应观测参数例如上述提及的视觉速度数据作为反馈是不准确的。为了进一步保证VIO姿态的稳定性,减少采用错误的特征点或质量较差的特征点用于计算而造成的姿态偏差,可以在VIO中加入重力更新,即重力优化,在稳定悬停状态下,可以修正在VIO坐标系下预估的水平面与在世界坐标系下的真实水平面之间的水平夹角偏差。
因此,本发明实施例还定义了悬停状态作为移动平台的上电状态之一,悬停状态主要是针对如图1所示的无人机之类的移动平台进行定义的,悬停状态是指无人机等移动平台在空中的某个位置停止不动。在悬停状态下,所使用的参考参数主要包括重力加速度即9.8m/s2。通过重力加速度来对在VIO坐标系下预估的水平面与在世界坐标系下的真实水平面之间的水平夹角偏差进行优化。
在悬停状态下,传感数据包括:姿态传感器采集的感测数据。姿态传感器例如可以是上述的IMU,包括加速度计和陀螺仪,而传感数据满足预设优化条件后即可以认为移动平台目前处于悬停状态且悬停较为稳定。
重力修正即对观测参数包括的第二角度参数的优化是在稳定悬停的时候进行的,此时的加速度基本为0,只能测量到朝向地心的重力加速度,所以用重力来修正是准确的。获取无人机飞行器是否处于稳定的悬停状态,可以是利用现有的状态量,从飞控获取到相应的悬停状态信号,甚至由用户观测判断飞行器悬停稳定后通过遥控信号发起移动平台处于悬停状态的通知。也可以在判定加速度模长、陀螺仪的模长、以及速度的模长都足够小时,即可说明飞行器稳定悬停了。在一个实施例中,传感数据满足预设优化条件可以包括如下情况中的任意一种或多种:
基于加速度计的感测数据计算的加速度模长小于预设的加速度模长阈值,具体的表达式可以表示为:||ma-ba||2<ath,其中,ma是指根据加速度计的感测数据计算得到的加速度,ba是指加速度计的零轴偏差、ath为加速度模长阈值;
基于陀螺仪的感测数据计算的角度模长小于预设的角度模长阈值,具体的表达式可以表示为:||mω-bω||2<ωth,其中,mω是指根据陀螺仪的感测数据计算得到的角度、bω是指陀螺仪的零轴偏差,ωth是指角度模长阈值;
基于加速度计的感测数据计算得到的速度模长小于预设的速度模长阈值,具体的表达式可以表示为:||V2||<Vth,其中,V是指基于加速度计的感测数据计算得到的速度,Vth是指速度模长阈值。
即只要悬停状态下的这些传感数据满足预设优化条件,则可以认为移动平台在悬停状态下为稳定状态,即稳定悬停。
进一步需要说明的是,IMU数据的更新频率比较高,例如可以达到200Hz,而VIO算法的更新速度比较低,例如仅为20Hz,为了保证数据的准确性,可以调用预置的低通滤波器对姿态传感器采集的感测数据进行滤波;对滤波后得到的数据进行处理,得到移动平台在上电状态下的传感数据。即将IMU数据做一个低通滤波,比如二阶巴特沃斯滤波,截止频率设为20Hz,可以滤除高频噪声,使得传感数据即姿态传感器采集的感测数据更准确。
在悬停状态下进行的重力修正即是对观测参数中包括的第二角度参数的优化,对观测参数进行优化,包括:对悬停状态下对应的移动平台的第二角度参数进行优化;其中,第二角度参数包括:视觉感知***预估的水平面与由世界坐标系下的真实水平面之间的第二夹角,第二夹角是对姿态传感器采集的感测数据进行计算得到的。
对第二夹角参数进行优化时所使用的残差公式如下:
其中,雅克比矩阵的表达式如下:
其中,θ即为:二维GPS位置传感器(世界坐标系下)确定的水平面与在VIO坐标系下预估的水平面之间的水平面夹角,ma为加速度计的测量值,ba是加速度计的零轴偏差。g是重力加速度,一般是9.8m/s2。δθ为第二角度参数的补偿量,是需要卡尔曼滤波器进行优化得到。在得到残差r以及雅克比矩阵后,可以调用预设的卡尔曼滤波器得到第二角度参数补偿量,在基于视觉感知***及VIO算法计算得到的第二角度参数的基础上加上该第二角度参数补偿量即完成对观测参数的优化。公式6中的Rwi是IMU所在的坐标系到世界坐标系的旋转变换矩阵,而公式7中的[]×是叉乘的矩阵表达。
在一个实施例中,可以采用非线性的误差状态的扩展卡尔曼滤波器(No-linearerror state EKF)优化得到第二角度参数补偿量。具体的,对于上述提及的公式6,具体是将Jθ和Jb、以及
作为No-linear error state EKF的输入数据,优化得到的输出数据包括δθ,在得到第二角度参数的补偿量δθ后,基于在基于VIO算法已经得到的θ基础上,加上第二角度参数的补偿量,即完成了对第二角度参数的优化。
基于上述实施例的描述,一方面,针对观测参数中第二角度参数容易被估计错误的情况,确定了在悬停状态下基于加速度计的测量值、加速度计的零轴偏差以及重力加速度等参考参数对第二角度参数进行优化,使得所说的第二角度参数能够更加准确地被优化,另一方面,还定义了用来确定处于稳定的悬停状态的确定条件,以便于能够获取准确的相关参考参数而不会被其他数据干扰,也较好地保证了对第二角度参数进行优化的准确性。
进一步的,经研究发现,移动平台的用户在移动平台上电后,并不是马上控制移动平台运动,例如对于飞行器而言,用户可能会倒提着飞行器到处走动以寻找起飞点,而此过程产生了较大的晃动,且飞行器处于倒立状态,若用户在找到合适起飞点后又立刻控制飞行器起飞,则此时飞行器的姿态估计并未收敛或收敛较慢,基于VIO算法就会计算出错误的姿态,造成起飞后悬停不稳定。
因此,在一个实施例中,定义了静置状态为移动平台的上电状态之一,在静置状态下,对陀螺仪的零轴偏差进行优化的参考参数可以为陀螺仪的当前读数,而由于移动平台静置,则陀螺仪的当前读数理论上为0。在静置状态下的传感数据包括:姿态传感器中的陀螺仪的测量值,为了加快计算收敛速度,可以对姿态传感器中的陀螺仪的测量值进行优化,具体可以是对姿态传感器中的陀螺仪参数即上述的陀螺仪的零轴偏差bias进行优化。陀螺仪的零轴偏差bias的修正需要在移动平台静置的时候(具体可以认为是落地且未启动电机),和上述提及的稳定悬停一样,可以利用现有的状态观测量从飞控获取,或者由用户观测确定处于静置状态后通过遥控器等设备进行通知。
在本发明实例中,也可以做一个判定处理,即判断传感数据满足预设优化条件包括:陀螺仪的零轴偏差的均值的模长小于预设的第一模长阈值,和/或,陀螺仪的零轴偏差的方差的模长小于预设的第二模长阈值。具体的,首先取最近N秒(例如1秒)内的陀螺仪的观测值即计算得到的陀螺仪的bias,求取均值μ和标准差σ,需要满足条件||μ||2<μT,||σ2||<σT,μT为均值阈值可以取0.05(或其他值),σT为标准差阈值可以取0.005(或其他值)来判定,符合条件就认为移动平台处于静置状态,且可认为移动平台在静置状态下为稳定状态,即稳定静置,可以用来更新优化陀螺仪的bias,否则不优化。
在一个实施例中,对静置状态下对应的移动平台中姿态传感器的陀螺仪参数进行优化的过程中,残差的计算表达式如下:
其中,雅克比矩阵的表达式为:
其中,mω是指基于陀螺仪的感测数据确定的角度,bω是指当前陀螺仪的零轴偏差,I是指Identity matrix单位矩阵。δbω是需要基于卡尔曼滤波器优化得到的值,表示为陀螺仪的零轴偏差的补偿量,将当前计算得到的陀螺仪的bias加上该δbω即可完成对姿态传感器中的陀螺仪参数的优化。
在一个实施例中,可以采用非线性的误差状态的扩展卡尔曼滤波器(No-linearerror state EKF)优化得到陀螺仪的零轴偏差的补偿量。具体的,对于上述提及的公式8,具体是将以及mω-bω作为No-linear error state EKF的输入数据,优化得到的输出数据即为δbω,在得到陀螺仪的零轴偏差的补偿量δbω后,在基于VIO算法已经得到的bω基础上,加上δbω,即完成了对陀螺仪的零轴偏差的优化。
基于上述实施例的描述,一方面确定了观测参数中陀螺仪的零轴偏差容易出现错误的场景,并且确定了一个静置状态,以便在该静置状态下快速地完成陀螺仪的零轴偏差的优化,另一方面定义了确定移动平台是否为静置状态的条件,能够准确地确定移动平台是否处于静置状态,也进一步较好地保证了对陀螺仪的零轴偏差进行优化的准确性。
本发明实施例能够对移动平台定义不同的上电状态,并在不同的上电状态下有针对性地对不同的基于视觉感知***的感测数据得到的观测数据进行优化,可以较好地保证观测参数优化的准确性和及时性,方便后续更加安全地对移动平台进行控制。并且从更好地对VIO计算的观测数据进行优化的角度出发,选择了在不同的判断条件下的上电状态来对观测参数进行优化,可以保证相应观测参数优化的准确性,使得移动平台能够得到更准确的控制。
再请参见图4,是本发明实施例的一种对移动平台的参数优化装置的结构示意图;所述装置可以设置在一个单独的控制设备中,也可以设置在移动平台的相应控制模块中,例如对于飞行器而言,可以设置在飞行器的飞行控制器中。在本发明实施例中,所述移动平台上设置有视觉感知***,所述视觉感知***包括姿态传感器和视觉传感器,所述装置包括如下模块。
确定模块401,用于确定所述移动平台当前的上电状态;获取模块402,用于获取所述移动平台在所述上电状态下采集的传感数据;优化模块403,用于若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数。
在一个实施例中,在所述获取所述移动平台在所述上电状态下的观测参数之前,所述获取模块402,还用于检测所述传感数据是否满足预设优化条件;若所述传感数据满足所述预设优化条件,则确定所述移动平台在所述上电状态下为稳定状态,可以触发所述优化模块403对现有的观测参数进行优化。
在一个实施例中,所述上电状态包括运动状态,所述移动平台还包括位置传感器,所述传感数据包括:获取的所述位置传感器的状态参数。
在一个实施例中,所述状态参数包括姿态参数、信号强度参数和速度精度估计指标;所述传感数据满足所述预设优化条件包括:所述姿态参数满足预设姿态条件、所述信号强度参数所指示的信号强度大于预设的强度阈值、所述速度精度估计指标小于预设的指标阈值中的任意一种或多种。
在一个实施例中,所述姿态参数包括:速度状态参数和高度状态参数;所述姿态参数满足姿态条件包括:所述速度状态参数所指示的速度大于预设的速度阈值,和/或所述高度状态参数所指示的高度大于预设的高度阈值。
在一个实施例中,所述观测参数包括:视觉速度数据;所述优化模块403在用于所述对所述观测参数进行优化时,用于对所述运动状态下对应的所述移动平台的视觉速度数据进行优化;其中,所述视觉速度数据是对所述姿态传感器和视觉传感器采集的感测数据进行计算得到的。
在一个实施例中,所述观测参数包括:第一角度参数;所述优化模块403在用于对所述观测参数进行优化时,用于对所述运动状态下对应的所述移动平台的第一角度参数进行优化;其中,所述第一角度参数包括:所述视觉感知***预估的北向与真实北向之间的第一夹角,所述第一夹角是对所述位置传感器和视觉传感器采集的感测数据进行计算得到的。
在一个实施例中,所述传感数据包括:所述移动平台的定位速度参数,所述装置还包括判断模块404,所述判断模块404,用于所述对所述运动状态下对应的所述移动平台的视觉速度数据进行优化之前,判断所述定位速度参数与所述视觉速度数据之间的差异是否满足预设的差异条件;若是,则触发所述优化模块403对所述运动状态下对应的所述移动平台的视觉速度数据进行优化。
在一个实施例中,所述定位速度参数与所述视觉速度数据之间的差异满足所述预设的差异条件包括:所述定位速度参数的模长与所述视觉速度数据的模长之间的差值大于预设的阈值。
在一个实施例中,所述传感数据中包括的定位速度参数是根据初始定位速度参数计算得到的,所述初始定位速度参数是根据所述位置传感器感测到的定位数据计算得到;所述装置还包括计算模块405,所述计算模块405,用于根据初始定位速度参数计算得到定位速度参数。在一个实施例中,所述计算模块405,具体是根据映射参数对所述初始定位速度参数进行映射计算,得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数;将映射速度参数作为定位速度参数。
在一个实施例中,所述计算模块405,在用于根据映射参数对所述初始定位速度参数进行映射计算,得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数时,用于获取所述姿态传感器感测得到的角速度参数,并获取所述姿态传感器与位置传感器之间的坐标系旋转变换矩阵;根据所述角速度参数、坐标系旋转变换矩阵、以及所述初始定位速度参数,计算得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数。
在一个实施例中,所述初始定位速度参数是在获取到所述姿态传感器采集的感测数据的预设时长阈值后、对所述位置传感器感测到的定位数据进行计算得到的。
在一个实施例中,所述上电状态包括悬停状态,所述传感数据包括:所述姿态传感器采集的感测数据。
在一个实施例中,所述姿态传感器包括加速度计和陀螺仪;所述传感数据满足所述预设优化条件包括:基于所述加速度计的感测数据计算的加速度模长小于预设的加速度模长阈值、基于所述陀螺仪的感测数据计算的角度模长小于预设的角度模长阈值、基于所述加速度计的感测数据计算得到的速度模长小于预设的速度模长阈值中的任意一种或者多种。
在一个实施例中,所述获取模块402,在用于获取所述移动平台在所述上电状态下的传感数据时,用于调用预置的低通滤波器对所述姿态传感器采集的感测数据进行滤波;对滤波后得到的数据进行处理,得到所述移动平台在所述上电状态下的传感数据。
在一个实施例中,所述观测参数包括:第二角度参数;所述优化模块403,在用于对所述观测参数进行优化时,用于对所述悬停状态下对应的所述移动平台的第二角度参数进行优化;其中,所述第二角度参数包括:所述视觉感知***预估的水平面与真实水平面之间的第二夹角,所述第二夹角是对所述姿态传感器采集的感测数据进行计算得到的。
在一个实施例中,所述上电状态包括静置状态,所述传感数据包括:所述姿态传感器中的陀螺仪的测量值。
在一个实施例中,所述传感数据满足所述预设优化条件包括:所述陀螺仪的零轴偏差的均值的模长小于预设的第一模长阈值,和/或,所述陀螺仪的零轴偏差的方差的模长小于预设的第二模长阈值。
在一个实施例中,所述观测参数包括:姿态传感器中的陀螺仪参数;所述优化模块403,在用于对所述观测参数进行优化时,用于对所述静置状态下对应的所述移动平台中姿态传感器的陀螺仪参数进行优化;其中,所述陀螺仪参数包括:所述姿态传感器中陀螺仪的零轴偏差。
在一个实施例中,所述获取模块402还用于获取所述移动平台在所述上电状态下的所述观测参数对应的参考参数;所述优化模块403,在用于对所述观测参数进行优化时,用于对所述参考参数和所述观测参数之间的差异数据进行优化,得到所述观测参数的观测补偿数据。
本发明实施例中,所述装置的各个模块的具体实现可参考前述各个实施例中相关内容的描述,在此不赘述。
本发明实施例能够对移动平台定义不同的上电状态,并在不同的上电状态下有针对性地对不同的基于视觉感知***的感测数据得到的观测数据进行优化,可以较好地保证观测参数优化的准确性和及时性,方便后续更加安全地对移动平台进行控制。并且从更好地对VIO计算的观测数据进行优化的角度出发,选择了在不同的判断条件下的上电状态来对观测参数进行优化,可以保证相应观测参数优化的准确性,使得移动平台能够得到更准确的控制。
再请参见图5,是本发明实施例的一种控制设备的结构示意图,本发明实施例的所述控制设备可以根据需要设置在移动平台中,用于对移动平台的数据进行优化。所述控制设备也可以作为一个外部设备与所述移动平台相连,用于接收所述移动平台的相关数据并对移动平台的数据进行优化。而所述移动平台可以为诸如飞行器、自动驾驶汽车等,所述控制设备与移动平台的视觉感知***相连,所述视觉感知***包括姿态传感器和视觉传感器。在本发明实施例中,所述控制设备包括通信接口501和处理器502,并且,所述控制设备还可以包括电源模块、用于与用户实现人机交互的用户接口等功能部件。
所述处理器502可以是中央处理器(central processing unit,CPU)。所述处理器502还可以进一步包括硬件芯片。上述硬件芯片可以是专用集成电路(application-specific integrated circuit,ASIC),可编程逻辑器件(programmable logic device,PLD)等。上述PLD可以是现场可编程逻辑门阵列(field-programmable gate array,FPGA),通用阵列逻辑(generic array logic,GAL)等。
在一个实施例中,所述控制设备还可以设置存储装置503与所述处理器502配合,所述存储装置503可以包括易失性存储器(volatile memory),例如随机存取存储器(random-access memory,RAM);存储装置503也可以包括非易失性存储器(non-volatilememory),例如快闪存储器(flash memory),固态硬盘(solid-state drive,SSD)等;存储装置503还可以包括上述种类的存储器的组合。所述处理器502可以调用所述存储装置503中存储的程序指令,用于实现前述实施例中的对移动平台的参数优化方法的各相关内容。
在一个实施例中,所述通信接口501,用于与视觉感知***相连,通信接口501可以通过有线或者无线的方式与移动平台相连;所述处理器502,用于确定所述移动平台当前的上电状态;获取所述移动平台在所述上电状态下采集的传感数据;若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数。
在一个实施例中,所述处理器502,还用于检测所述传感数据是否满足预设优化条件;若所述传感数据满足所述预设优化条件,则确定所述移动平台在所述上电状态下为稳定状态,可以对观测参数进行优化。
在一个实施例中,所述上电状态包括运动状态,所述移动平台还包括位置传感器,所述传感数据包括:获取的所述位置传感器的状态参数。
在一个实施例中,所述状态参数包括姿态参数、信号强度参数和速度精度估计指标中的一种或多种;所述传感数据满足所述预设优化条件包括:所述姿态参数满足预设姿态条件、所述信号强度参数所指示的信号强度大于预设的强度阈值、所述速度精度估计指标小于预设的指标阈值中的任意一种或多种。
在一个实施例中,所述姿态参数包括:速度状态参数和/或高度状态参数;所述姿态参数满足姿态条件包括:所述速度状态参数所指示的速度大于预设的速度阈值,和/或所述高度状态参数所指示的高度大于预设的高度阈值。
在一个实施例中,所述观测参数包括:视觉速度数据;所述处理器502,用于对所述运动状态下对应的所述移动平台的视觉速度数据进行优化;其中,所述视觉速度数据是对所述姿态传感器和视觉传感器采集的感测数据进行计算得到的。
在一个实施例中,所述观测参数包括:第一角度参数;所述处理器502,用于对所述运动状态下对应的所述移动平台的第一角度参数进行优化;其中,所述第一角度参数包括:所述视觉感知***预估的北向与真实北向之间的第一夹角,所述第一夹角是对所述位置传感器和视觉传感器采集的感测数据进行计算得到的。
在一个实施例中,所述传感数据包括:所述移动平台的定位速度参数,所述处理器502,还用于判断所述定位速度参数与所述视觉速度数据之间的差异是否满足预设的差异条件;并在满足预设的差异条件时对所述运动状态下对应的所述移动平台的视觉速度数据进行优化。
在一个实施例中,所述定位速度参数与所述视觉速度数据之间的差异满足所述预设的差异条件包括:所述定位速度参数的模长与所述视觉速度数据的模长之间的差值大于预设的阈值。
在一个实施例中,所述传感数据中包括的定位速度参数是根据初始定位速度参数计算得到的,所述初始定位速度参数是根据所述位置传感器感测到的定位数据计算得到;所述处理器502,用于根据映射参数对所述初始定位速度参数进行映射计算,得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数;将映射速度参数作为定位速度参数。
在一个实施例中,所述处理器502,用于获取所述姿态传感器感测得到的角速度参数,并获取所述姿态传感器与位置传感器之间的坐标系旋转变换矩阵;根据所述角速度参数、坐标系旋转变换矩阵、以及所述初始定位速度参数,计算得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数。
在一个实施例中,所述初始定位速度参数是在获取到所述姿态传感器采集的感测数据的预设时长阈值后、对所述位置传感器感测到的定位数据进行计算得到的。
在一个实施例中,所述上电状态包括悬停状态,所述传感数据包括:所述姿态传感器采集的感测数据。
在一个实施例中,所述姿态传感器包括加速度计和陀螺仪;所述传感数据满足所述预设优化条件包括:基于所述加速度计的感测数据计算的加速度模长小于预设的加速度模长阈值、基于所述陀螺仪的感测数据计算的角度模长小于预设的角度模长阈值、基于所述加速度计的感测数据计算得到的速度模长小于预设的速度模长阈值中的任意一种或者多种。
在一个实施例中,所述处理器502,用于调用预置的低通滤波器对所述姿态传感器采集的感测数据进行滤波;对滤波后得到的数据进行处理,得到所述移动平台在所述上电状态下的传感数据。
在一个实施例中,所述观测参数包括:第二角度参数;所述处理器502,用于对所述悬停状态下对应的所述移动平台的第二角度参数进行优化;其中,所述第二角度参数包括:所述视觉感知***预估的水平面与真实水平面之间的第二夹角,所述第二夹角是对所述姿态传感器采集的感测数据进行计算得到的。
在一个实施例中,所述上电状态包括静置状态,所述传感数据包括:所述姿态传感器中的陀螺仪的测量值。
在一个实施例中,所述传感数据满足所述预设优化条件包括:所述陀螺仪的零轴偏差的均值的模长小于预设的第一模长阈值,和/或,所述陀螺仪的零轴偏差的方差的模长小于预设的第二模长阈值。
在一个实施例中,所述观测参数包括:姿态传感器中的陀螺仪参数;所述对所述观测参数进行优化,包括:对所述静置状态下对应的所述移动平台中姿态传感器的陀螺仪参数进行优化;其中,所述陀螺仪参数包括:所述姿态传感器中陀螺仪的零轴偏差。
在一个实施例中,所述处理器502,还用于获取所述移动平台在所述上电状态下的所述观测参数对应的参考参数;并且,所述处理器502对所述观测参数进行优化是指:对所述参考参数和所述观测参数之间的差异数据进行优化,得到所述观测参数的观测补偿数据。
本发明实施例中,所述控制设备的处理器的具体实现可参考前述各个实施例中相关内容的描述,在此不赘述。
本发明实施例能够对移动平台定义不同的上电状态,并在不同的上电状态下有针对性地对不同的基于视觉感知***的感测数据得到的观测数据进行优化,可以较好地保证观测参数优化的准确性和及时性,方便后续更加安全地对移动平台进行控制。并且从更好地对VIO计算的观测数据进行优化的角度出发,选择了在不同的判断条件下的上电状态来对观测参数进行优化,可以保证相应观测参数优化的准确性,使得移动平台能够得到更准确的控制。
另外,本发明实施例还提供了一种飞行器,该飞行器的一种组成部分可参考图1所示。图1示出的是一种多旋翼飞行器,该飞行器具体可以是四旋翼飞行器、六旋翼飞行器、八旋翼飞行器等能够通过旋翼带动飞行的飞行器。在其他实施例中,该飞行器也可以为固定翼飞行器等。所述飞行器包括:视觉感知***100、控制器103、动力组件104,其中,所述视觉感知***100包括姿态传感器101和视觉传感器102。另外,在具体实现时,所述飞行器还包括供电模块,并可以根据需要包括诸如指南针、超声波等传感器,变形机构等结构。
所述控制器103可以是CPU。所述控制器103还可以进一步包括硬件芯片。上述硬件芯片可以是ASIC,PLD等。上述PLD可以是FPGA,GAL等。在一个实施例中,所述飞行器还可以包括存储装置与所述控制器103配合,所述存储装置可以包括易失性存储器(volatilememory),例如RAM;存储装置也可以包括非易失性存储器(non-volatile memory),例如快闪存储器(flash memory),SSD等;存储装置还可以包括上述种类的存储器的组合。所述控制器103可以调用所述存储装置中存储的程序指令,用于实现前述实施例中的对移动平台的参数优化方法的各相关内容。
在一个实施例中,所述控制器103,用于根据所述姿态传感器101和/或所述视觉传感器102的感测数据计算得到观测参数,并且用于确定所述移动平台当前的上电状态;获取所述移动平台在所述上电状态下采集的传感数据;若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数,并用于基于修正后的观测参数对所述动力组件104进行控制,以控制所述飞行器运动。
在一个实施例中,所述控制器103,还用于检测所述传感数据是否满足预设优化条件;若所述传感数据满足所述预设优化条件,则确定所述移动平台在所述上电状态下为稳定状态。
在一个实施例中,所述上电状态包括运动状态,所述移动平台还包括位置传感器,所述传感数据包括:获取的所述位置传感器的状态参数。
在一个实施例中,所述状态参数包括姿态参数、信号强度参数和速度精度估计指标中的一种或多种;所述传感数据满足所述预设优化条件包括:所述姿态参数满足预设姿态条件、所述信号强度参数所指示的信号强度大于预设的强度阈值、所述速度精度估计指标小于预设的指标阈值中的任意一种或多种。
在一个实施例中,所述姿态参数包括:速度状态参数和/或高度状态参数;所述姿态参数满足姿态条件包括:所述速度状态参数所指示的速度大于预设的速度阈值,和/或所述高度状态参数所指示的高度大于预设的高度阈值。
在一个实施例中,所述观测参数包括:视觉速度数据;所述控制器103,用于对所述运动状态下对应的所述移动平台的视觉速度数据进行优化;其中,所述视觉速度数据是对所述位置传感器和视觉传感器102采集的感测数据进行计算得到的。
在一个实施例中,所述观测参数包括:第一角度参数;所述控制器103,用于对所述运动状态下对应的所述移动平台的第一角度参数进行优化;其中,所述第一角度参数包括:所述视觉感知***100预估的北向与真实北向之间的第一夹角,所述第一夹角是对所述位置传感器和视觉传感器102采集的感测数据进行计算得到的。
在一个实施例中,所述传感数据包括:所述移动平台的定位速度参数,所述控制器103,还用于判断所述定位速度参数与所述视觉速度数据之间的差异是否满足预设的差异条件;并在满足预设的差异条件时对所述运动状态下对应的所述移动平台的视觉速度数据进行优化。
在一个实施例中,所述定位速度参数与所述视觉速度数据之间的差异满足所述预设的差异条件包括:所述定位速度参数的模长与所述视觉速度数据的模长之间的差值大于预设的阈值。
在一个实施例中,所述传感数据中包括的定位速度参数是根据初始定位速度参数计算得到的,所述初始定位速度参数是根据所述位置传感器感测到的定位数据计算得到;所述控制器103,用于根据映射参数对所述初始定位速度参数进行映射计算,得到所述位置传感器在所述姿态传感器101所在坐标系下的映射速度参数;将映射速度参数作为定位速度参数。
在一个实施例中,所述控制器103,用于获取所述姿态传感器101感测得到的角速度参数,并获取所述姿态传感器101与位置传感器之间的坐标系旋转变换矩阵;根据所述角速度参数、坐标系旋转变换矩阵、以及所述初始定位速度参数,计算得到所述位置传感器在所述姿态传感器101所在坐标系下的映射速度参数。
在一个实施例中,所述初始定位速度参数是在获取到所述姿态传感器101采集的感测数据的预设时长阈值后、对所述位置传感器感测到的定位数据进行计算得到的。
在一个实施例中,所述上电状态包括悬停状态,所述传感数据包括:所述姿态传感器101采集的感测数据。
在一个实施例中,所述姿态传感器101包括加速度计和陀螺仪;所述传感数据满足所述预设优化条件包括:基于所述加速度计的感测数据计算的加速度模长小于预设的加速度模长阈值、基于所述陀螺仪的感测数据计算的角度模长小于预设的角度模长阈值、基于所述加速度计的感测数据计算得到的速度模长小于预设的速度模长阈值中的任意一种或者多种。
在一个实施例中,所述控制器103,用于调用预置的低通滤波器对所述姿态传感器101采集的感测数据进行滤波;对滤波后得到的数据进行处理,得到所述移动平台在所述上电状态下的传感数据。
在一个实施例中,所述观测参数包括:第二角度参数;所述控制器103,用于对所述悬停状态下对应的所述移动平台的第二角度参数进行优化;其中,所述第二角度参数包括:所述视觉感知***100预估的水平面与真实水平面之间的第二夹角,所述第二夹角是对所述姿态传感器101采集的感测数据进行计算得到的。
在一个实施例中,所述上电状态包括静置状态,所述传感数据包括:所述姿态传感器101中的陀螺仪的测量值。
在一个实施例中,所述传感数据满足所述预设优化条件包括:所述陀螺仪的零轴偏差的均值的模长小于预设的第一模长阈值,和/或,所述陀螺仪的零轴偏差的方差的模长小于预设的第二模长阈值。
在一个实施例中,所述观测参数包括:姿态传感器101中的陀螺仪参数;所述对所述观测参数进行优化,包括:对所述静置状态下对应的所述移动平台中姿态传感器101的陀螺仪参数进行优化;其中,所述陀螺仪参数包括:所述姿态传感器101中陀螺仪的零轴偏差。
在一个实施例中,所述控制器103,还用于获取所述移动平台在所述上电状态下的所述观测参数对应的参考参数;并且,所述控制器103对所述观测参数进行优化是指:对所述参考参数和所述观测参数之间的差异数据进行优化,得到所述观测参数的观测补偿数据。
本发明实施例中,所述飞行器中控制器的具体实现可参考前述各个实施例中相关内容的描述,在此不赘述。
本发明实施例能够对移动平台定义不同的上电状态,并在不同的上电状态下有针对性地对不同的基于视觉感知***的感测数据得到的观测数据进行优化,可以较好地保证观测参数优化的准确性和及时性,方便后续更加安全地对移动平台进行控制。并且从更好地对VIO计算的观测数据进行优化的角度出发,选择了在不同的判断条件下的上电状态来对观测参数进行优化,可以保证相应观测参数优化的准确性,使得移动平台能够得到更准确的控制。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random AccessMemory,RAM)等。
以上所揭露的仅为本发明部分实施例而已,当然不能以此来限定本发明之权利范围,因此依本发明权利要求所作的等同变化,仍属本发明所涵盖的范围。
Claims (61)
1.一种对移动平台的参数优化方法,其特征在于,所述移动平台上设置有视觉感知***,所述视觉感知***包括姿态传感器和视觉传感器,所述方法包括:
确定所述移动平台当前的上电状态;
获取所述移动平台在所述上电状态下采集的传感数据;
若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;
其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数。
2.根据权利要求1所述的方法,其特征在于,所述方法还包括:
检测所述传感数据是否满足预设优化条件;
若所述传感数据满足所述预设优化条件,则确定所述移动平台在所述上电状态下为稳定状态。
3.如权利要求2所述的方法,其特征在于,所述上电状态包括运动状态,所述移动平台还包括位置传感器,所述传感数据包括:获取的所述位置传感器的状态参数。
4.如权利要求3所述的方法,其特征在于,所述状态参数包括姿态参数、信号强度参数和速度精度估计指标中的一种或多种;
所述传感数据满足所述预设优化条件包括:所述姿态参数满足预设姿态条件、所述信号强度参数所指示的信号强度大于预设的强度阈值、所述速度精度估计指标小于预设的指标阈值中的任意一种或多种。
5.如权利要求4所述的方法,其特征在于,所述姿态参数包括:速度状态参数和/或高度状态参数;
所述姿态参数满足姿态条件包括:所述速度状态参数所指示的速度大于预设的速度阈值,和/或所述高度状态参数所指示的高度大于预设的高度阈值。
6.如权利要求3所述的方法,其特征在于,所述观测参数包括:视觉速度数据;
所述对所述上电状态所对应的所述移动平台的观测参数进行优化,包括:对所述运动状态下对应的所述移动平台的视觉速度数据进行优化;
其中,所述视觉速度数据是对所述姿态传感器和视觉传感器采集的感测数据进行计算得到的。
7.如权利要求3所述的方法,其特征在于,所述观测参数包括:第一角度参数;
所述对所述上电状态所对应的所述移动平台的观测参数进行优化,包括:对所述运动状态下对应的所述移动平台的第一角度参数进行优化;
其中,所述第一角度参数包括:所述视觉感知***预估的北向与真实北向之间的第一夹角,所述第一夹角是对所述位置传感器和视觉传感器采集的感测数据进行计算得到的。
8.如权利要求7所述的方法,其特征在于,所述传感数据包括:所述移动平台的定位速度参数,所述对所述运动状态下对应的所述移动平台的视觉速度数据进行优化之前,还包括:
判断所述定位速度参数与所述视觉速度数据之间的差异是否满足预设的差异条件;
若是,则触发执行所述对所述运动状态下对应的所述移动平台的视觉速度数据进行优化。
9.如权利要求8所述的方法,其特征在于,所述定位速度参数与所述视觉速度数据之间的差异满足所述预设的差异条件包括:所述定位速度参数的模长与所述视觉速度数据的模长之间的差值大于预设的阈值。
10.如权利要求2-9任一项所述的方法,其特征在于,所述传感数据中包括的定位速度参数是根据初始定位速度参数计算得到的,所述初始定位速度参数是根据所述位置传感器感测到的定位数据计算得到;
其中,根据初始定位速度参数计算得到定位速度参数,包括:
根据映射参数对所述初始定位速度参数进行映射计算,得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数;
将映射速度参数作为定位速度参数。
11.如权利要求10所述的方法,其特征在于,所述根据映射参数对所述初始定位速度参数进行映射计算,得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数,包括:
获取所述姿态传感器感测得到的角速度参数,并获取所述姿态传感器与位置传感器之间的坐标系旋转变换矩阵;
根据所述角速度参数、坐标系旋转变换矩阵、以及所述初始定位速度参数,计算得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数。
12.如权利要求10所述的方法,其特征在于,所述初始定位速度参数是在获取到所述姿态传感器采集的感测数据的预设时长阈值后、对所述位置传感器感测到的定位数据进行计算得到的。
13.如权利要求2所述的方法,其特征在于,所述上电状态包括悬停状态,所述传感数据包括:基于所述姿态传感器采集的感测数据计算得到的数据。
14.如权利要求13所述的方法,其特征在于,所述姿态传感器包括加速度计和陀螺仪;
所述传感数据满足所述预设优化条件包括:基于所述加速度计的感测数据计算的加速度模长小于预设的加速度模长阈值、基于所述陀螺仪的感测数据计算的角度模长小于预设的角度模长阈值、基于所述加速度计的感测数据计算得到的速度模长小于预设的速度模长阈值中的任意一种或者多种。
15.如权利要求13或14所述的方法,其特征在于,所述获取所述移动平台在所述上电状态下的传感数据,包括:
调用预置的低通滤波器对所述姿态传感器采集的感测数据进行滤波;
对滤波后得到的数据进行处理,得到所述移动平台在所述上电状态下的传感数据。
16.如权利要求13所述的方法,其特征在于,所述观测参数包括:第二角度参数;
所述对所述上电状态所对应的所述移动平台的观测参数进行优化,包括:对所述悬停状态下对应的所述移动平台的第二角度参数进行优化;
其中,所述第二角度参数包括:所述视觉感知***预估的水平面与真实水平面之间的第二夹角,所述第二夹角是对所述姿态传感器采集的感测数据进行计算得到的。
17.如权利要求2所述的方法,其特征在于,所述上电状态包括静置状态,所述传感数据包括:所述姿态传感器中的陀螺仪的测量值。
18.如权利要求17所述的方法,其特征在于,所述传感数据满足所述预设优化条件包括:所述陀螺仪的零轴偏差的均值的模长小于预设的第一模长阈值,和/或,所述陀螺仪的零轴偏差的方差的模长小于预设的第二模长阈值。
19.如权利要求17或18所述的方法,其特征在于,所述观测参数包括:姿态传感器中的陀螺仪参数;
所述对所述上电状态所对应的所述移动平台的观测参数进行优化,包括:对所述静置状态下对应的所述移动平台中姿态传感器的陀螺仪参数进行优化;
其中,所述陀螺仪参数包括:所述姿态传感器中陀螺仪的零轴偏差。
20.根据权利要求1所述的方法,其特征在于,所述方法还包括:
获取所述移动平台在所述上电状态下的所述观测参数对应的参考参数;
所述对所述上电状态所对应的所述移动平台的观测参数进行优化,包括:
对所述参考参数和所述观测参数之间的差异数据进行优化,得到所述观测参数的观测补偿数据。
21.一种对移动平台的参数优化装置,其特征在于,所述移动平台上设置有视觉感知***,所述视觉感知***包括姿态传感器和视觉传感器,所述装置包括:
确定模块,用于确定所述移动平台当前的上电状态;
获取模块,用于获取所述移动平台在所述上电状态下采集的传感数据;
优化模块,用于若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;
其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数。
22.一种控制设备,其特征在于,所述控制设备用于对移动平台进行参数优化,所述控制设备与移动平台的视觉感知***相连,所述视觉感知***包括姿态传感器和视觉传感器,所述控制设备包括:通信接口和处理器;
所述通信接口,用于与视觉感知***相连;
所述处理器,用于确定所述移动平台当前的上电状态;获取所述移动平台在所述上电状态下采集的传感数据;若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数。
23.根据权利要求22所述的控制设备,其特征在于,
所述处理器,还用于检测所述传感数据是否满足预设优化条件;若所述传感数据满足所述预设优化条件,则确定所述移动平台在所述上电状态下为稳定状态。
24.如权利要求23所述的控制设备,其特征在于,所述上电状态包括运动状态,所述移动平台还包括位置传感器,所述传感数据包括:获取的所述位置传感器的状态参数。
25.如权利要求24所述的控制设备,其特征在于,所述状态参数包括姿态参数、信号强度参数和速度精度估计指标中的一种或多种;
所述传感数据满足所述预设优化条件包括:所述姿态参数满足预设姿态条件、所述信号强度参数所指示的信号强度大于预设的强度阈值、所述速度精度估计指标小于预设的指标阈值中的任意一种或多种。
26.如权利要求25所述的控制设备,其特征在于,所述姿态参数包括:速度状态参数和/或高度状态参数;
所述姿态参数满足姿态条件包括:所述速度状态参数所指示的速度大于预设的速度阈值,和/或所述高度状态参数所指示的高度大于预设的高度阈值。
27.如权利要求24所述的控制设备,其特征在于,所述观测参数包括:视觉速度数据;
所述处理器,用于对所述运动状态下对应的所述移动平台的视觉速度数据进行优化;
其中,所述视觉速度数据是对所述姿态传感器和视觉传感器采集的感测数据进行计算得到的。
28.如权利要求24所述的控制设备,其特征在于,所述观测参数包括:第一角度参数;
所述处理器,用于对所述运动状态下对应的所述移动平台的第一角度参数进行优化;
其中,所述第一角度参数包括:所述视觉感知***预估的北向与真实北向之间的第一夹角,所述第一夹角是对所述位置传感器和视觉传感器采集的感测数据进行计算得到的。
29.如权利要求28所述的控制设备,其特征在于,所述传感数据包括:所述移动平台的定位速度参数,所述处理器,还用于判断所述定位速度参数与所述视觉速度数据之间的差异是否满足预设的差异条件;并在满足预设的差异条件时对所述运动状态下对应的所述移动平台的视觉速度数据进行优化。
30.如权利要求29所述的控制设备,其特征在于,所述定位速度参数与所述视觉速度数据之间的差异满足所述预设的差异条件包括:所述定位速度参数的模长与所述视觉速度数据的模长之间的差值大于预设的阈值。
31.如权利要求23-30任一项所述的控制设备,其特征在于,所述传感数据中包括的定位速度参数是根据初始定位速度参数计算得到的,所述初始定位速度参数是根据所述位置传感器感测到的定位数据计算得到;
所述处理器,用于根据映射参数对所述初始定位速度参数进行映射计算,得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数;将映射速度参数作为定位速度参数。
32.如权利要求31所述的控制设备,其特征在于,所述处理器,用于获取所述姿态传感器感测得到的角速度参数,并获取所述姿态传感器与位置传感器之间的坐标系旋转变换矩阵;根据所述角速度参数、坐标系旋转变换矩阵、以及所述初始定位速度参数,计算得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数。
33.如权利要求31所述的控制设备,其特征在于,所述初始定位速度参数是在获取到所述姿态传感器采集的感测数据的预设时长阈值后、对所述位置传感器感测到的定位数据进行计算得到的。
34.如权利要求23所述的控制设备,其特征在于,所述上电状态包括悬停状态,所述传感数据包括:所述姿态传感器采集的感测数据。
35.如权利要求34所述的控制设备,其特征在于,所述姿态传感器包括加速度计和陀螺仪;
所述传感数据满足所述预设优化条件包括:基于所述加速度计的感测数据计算的加速度模长小于预设的加速度模长阈值、基于所述陀螺仪的感测数据计算的角度模长小于预设的角度模长阈值、基于所述加速度计的感测数据计算得到的速度模长小于预设的速度模长阈值中的任意一种或者多种。
36.如权利要求34或35所述的控制设备,其特征在于,所述处理器,用于调用预置的低通滤波器对所述姿态传感器采集的感测数据进行滤波;对滤波后得到的数据进行处理,得到所述移动平台在所述上电状态下的传感数据。
37.如权利要求34所述的控制设备,其特征在于,所述观测参数包括:第二角度参数;
所述处理器,用于对所述悬停状态下对应的所述移动平台的第二角度参数进行优化;
其中,所述第二角度参数包括:所述视觉感知***预估的水平面与真实水平面之间的第二夹角,所述第二夹角是对所述姿态传感器采集的感测数据进行计算得到的。
38.如权利要求22所述的控制设备,其特征在于,所述上电状态包括静置状态,所述传感数据包括:所述姿态传感器中的陀螺仪的测量值。
39.如权利要求38所述的控制设备,其特征在于,所述传感数据满足所述预设优化条件包括:所述陀螺仪的零轴偏差的均值的模长小于预设的第一模长阈值,和/或,所述陀螺仪的零轴偏差的方差的模长小于预设的第二模长阈值。
40.如权利要求38或39所述的控制设备,其特征在于,所述观测参数包括:姿态传感器中的陀螺仪参数;
所述对所述观测参数进行优化,包括:对所述静置状态下对应的所述移动平台中姿态传感器的陀螺仪参数进行优化;
其中,所述陀螺仪参数包括:所述姿态传感器中陀螺仪的零轴偏差。
41.根据权利要求22所述的控制设备,其特征在于,所述处理器,还用于获取所述移动平台在所述上电状态下的所述观测参数对应的参考参数;并且,所述处理器对所述观测参数进行优化是指:对所述参考参数和所述观测参数之间的差异数据进行优化,得到所述观测参数的观测补偿数据。
42.一种飞行器,其特征在于,所述飞行器包括:视觉感知***、控制器、动力组件,其中,所述视觉感知***包括姿态传感器和视觉传感器;
所述控制器,用于根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到观测参数,并且用于确定所述移动平台当前的上电状态;获取所述移动平台在所述上电状态下采集的传感数据;若根据所述传感数据确定所述移动平台在所述上电状态下为稳定状态,则对所述上电状态所对应的所述移动平台的观测参数进行优化,以修正所述观测参数;其中,所述观测参数是根据所述姿态传感器和/或所述视觉传感器的感测数据计算得到的,所述移动平台包括多个上电状态,在不同的上电状态下对应有不同的观测参数,并用于基于修正后的观测参数对所述动力组件进行控制,以控制所述飞行器运动。
43.根据权利要求42所述的飞行器,其特征在于,
所述控制器,还用于检测所述传感数据是否满足预设优化条件;若所述传感数据满足所述预设优化条件,则确定所述移动平台在所述上电状态下为稳定状态。
44.如权利要求43所述的飞行器,其特征在于,所述上电状态包括运动状态,所述移动平台还包括位置传感器,所述传感数据包括:获取的所述位置传感器的状态参数。
45.如权利要求44所述的飞行器,其特征在于,所述状态参数包括姿态参数、信号强度参数和速度精度估计指标中的一种或多种;
所述传感数据满足所述预设优化条件包括:所述姿态参数满足预设姿态条件、所述信号强度参数所指示的信号强度大于预设的强度阈值、所述速度精度估计指标小于预设的指标阈值中的任意一种或多种。
46.如权利要求45所述的飞行器,其特征在于,所述姿态参数包括:速度状态参数和/或高度状态参数;
所述姿态参数满足姿态条件包括:所述速度状态参数所指示的速度大于预设的速度阈值,和/或所述高度状态参数所指示的高度大于预设的高度阈值。
47.如权利要求44所述的飞行器,其特征在于,所述观测参数包括:视觉速度数据;
所述控制器,用于对所述运动状态下对应的所述移动平台的视觉速度数据进行优化;
其中,所述视觉速度数据是对所述姿态传感器和视觉传感器采集的感测数据进行计算得到的。
48.如权利要求44所述的飞行器,其特征在于,所述观测参数包括:第一角度参数;
所述控制器,用于对所述运动状态下对应的所述移动平台的第一角度参数进行优化;
其中,所述第一角度参数包括:所述视觉感知***预估的北向与真实北向之间的第一夹角,所述第一夹角是对所述位置传感器和视觉传感器采集的感测数据进行计算得到的。
49.如权利要求48所述的飞行器,其特征在于,所述传感数据包括:所述移动平台的定位速度参数,所述控制器,还用于判断所述定位速度参数与所述视觉速度数据之间的差异是否满足预设的差异条件;并在满足预设的差异条件时对所述运动状态下对应的所述移动平台的视觉速度数据进行优化。
50.如权利要求49所述的飞行器,其特征在于,所述定位速度参数与所述视觉速度数据之间的差异满足所述预设的差异条件包括:所述定位速度参数的模长与所述视觉速度数据的模长之间的差值大于预设的阈值。
51.如权利要求43-50任一项所述的飞行器,其特征在于,所述传感数据中包括的定位速度参数是根据初始定位速度参数计算得到的,所述初始定位速度参数是根据所述位置传感器感测到的定位数据计算得到;
所述控制器,用于根据映射参数对所述初始定位速度参数进行映射计算,得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数;将映射速度参数作为定位速度参数。
52.如权利要求51所述的飞行器,其特征在于,所述控制器,用于获取所述姿态传感器感测得到的角速度参数,并获取所述姿态传感器与位置传感器之间的坐标系旋转变换矩阵;根据所述角速度参数、坐标系旋转变换矩阵、以及所述初始定位速度参数,计算得到所述位置传感器在所述姿态传感器所在坐标系下的映射速度参数。
53.如权利要求51所述的飞行器,其特征在于,所述初始定位速度参数是在获取到所述姿态传感器采集的感测数据的预设时长阈值后、对所述位置传感器感测到的定位数据进行计算得到的。
54.如权利要求53所述的飞行器,其特征在于,所述上电状态包括悬停状态,所述传感数据包括:所述姿态传感器采集的感测数据。
55.如权利要求54所述的飞行器,其特征在于,所述姿态传感器包括加速度计和陀螺仪;
所述传感数据满足所述预设优化条件包括:基于所述加速度计的感测数据计算的加速度模长小于预设的加速度模长阈值、基于所述陀螺仪的感测数据计算的角度模长小于预设的角度模长阈值、基于所述加速度计的感测数据计算得到的速度模长小于预设的速度模长阈值中的任意一种或者多种。
56.如权利要求54或55所述的飞行器,其特征在于,所述控制器,用于调用预置的低通滤波器对所述姿态传感器采集的感测数据进行滤波;对滤波后得到的数据进行处理,得到所述移动平台在所述上电状态下的传感数据。
57.如权利要求54所述的飞行器,其特征在于,所述观测参数包括:第二角度参数;
所述控制器,用于对所述悬停状态下对应的所述移动平台的第二角度参数进行优化;
其中,所述第二角度参数包括:所述视觉感知***预估的水平面与真实水平面之间的第二夹角,所述第二夹角是对所述姿态传感器采集的感测数据进行计算得到的。
58.如权利要求42所述的飞行器,其特征在于,所述上电状态包括静置状态,所述传感数据包括:所述姿态传感器中的陀螺仪的测量值。
59.如权利要求58所述的飞行器,其特征在于,所述传感数据满足所述预设优化条件包括:所述陀螺仪的零轴偏差的均值的模长小于预设的第一模长阈值,和/或,所述陀螺仪的零轴偏差的方差的模长小于预设的第二模长阈值。
60.如权利要求58或59所述的飞行器,其特征在于,所述观测参数包括:姿态传感器中的陀螺仪参数;
所述对所述观测参数进行优化,包括:对所述静置状态下对应的所述移动平台中姿态传感器的陀螺仪参数进行优化;
其中,所述陀螺仪参数包括:所述姿态传感器中陀螺仪的零轴偏差。
61.根据权利要求42所述的飞行器,其特征在于,所述控制器,还用于获取所述移动平台在所述上电状态下的所述观测参数对应的参考参数;并且,所述控制器对所述观测参数进行优化是指:对所述参考参数和所述观测参数之间的差异数据进行优化,得到所述观测参数的观测补偿数据。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2018/118768 WO2020107473A1 (zh) | 2018-11-30 | 2018-11-30 | 对移动平台的参数优化方法、装置及控制设备、飞行器 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110785722A true CN110785722A (zh) | 2020-02-11 |
Family
ID=69383255
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201880038852.6A Pending CN110785722A (zh) | 2018-11-30 | 2018-11-30 | 对移动平台的参数优化方法、装置及控制设备、飞行器 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN110785722A (zh) |
WO (1) | WO2020107473A1 (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113406964A (zh) * | 2021-05-19 | 2021-09-17 | 浙江华飞智能科技有限公司 | 运动参数调节方法、装置、存储介质及电子装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8275544B1 (en) * | 2005-11-21 | 2012-09-25 | Miltec Missiles & Space | Magnetically stabilized forward observation platform |
US20130103344A1 (en) * | 2011-10-25 | 2013-04-25 | Honeywell International Inc. | Method to improve leveling performance in navigation systems |
CN106441301A (zh) * | 2016-09-19 | 2017-02-22 | 北京机械设备研究所 | 一种飞行器发射初始参数获取方法及*** |
CN107065900A (zh) * | 2017-01-17 | 2017-08-18 | 清华大学 | 无人机飞行控制参数更新*** |
CN207908981U (zh) * | 2018-03-26 | 2018-09-25 | 东汉太阳能无人机技术有限公司 | 一种无人机飞控*** |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105425791B (zh) * | 2015-11-06 | 2019-01-29 | 武汉理工大学 | 一种基于视觉定位的群机器人控制***及方法 |
CN108663067A (zh) * | 2017-03-30 | 2018-10-16 | 杭州维圣智能科技有限公司 | 一种运动传感器的自适应校准方法和*** |
CN108873928A (zh) * | 2017-05-10 | 2018-11-23 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种基于传感器状态评估结果的无人直升机高度保持方法 |
-
2018
- 2018-11-30 WO PCT/CN2018/118768 patent/WO2020107473A1/zh active Application Filing
- 2018-11-30 CN CN201880038852.6A patent/CN110785722A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8275544B1 (en) * | 2005-11-21 | 2012-09-25 | Miltec Missiles & Space | Magnetically stabilized forward observation platform |
US20130103344A1 (en) * | 2011-10-25 | 2013-04-25 | Honeywell International Inc. | Method to improve leveling performance in navigation systems |
CN106441301A (zh) * | 2016-09-19 | 2017-02-22 | 北京机械设备研究所 | 一种飞行器发射初始参数获取方法及*** |
CN107065900A (zh) * | 2017-01-17 | 2017-08-18 | 清华大学 | 无人机飞行控制参数更新*** |
CN207908981U (zh) * | 2018-03-26 | 2018-09-25 | 东汉太阳能无人机技术有限公司 | 一种无人机飞控*** |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113406964A (zh) * | 2021-05-19 | 2021-09-17 | 浙江华飞智能科技有限公司 | 运动参数调节方法、装置、存储介质及电子装置 |
CN113406964B (zh) * | 2021-05-19 | 2022-11-18 | 浙江华飞智能科技有限公司 | 运动参数调节方法、装置、存储介质及电子装置 |
Also Published As
Publication number | Publication date |
---|---|
WO2020107473A1 (zh) | 2020-06-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106959110B (zh) | 一种云台姿态检测方法及装置 | |
CN109887057B (zh) | 生成高精度地图的方法和装置 | |
EP3158412B1 (en) | Sensor fusion using inertial and image sensors | |
US11669054B2 (en) | Method and apparatus for operating mobile platform | |
US10060746B2 (en) | Methods and systems for determining a state of an unmanned aerial vehicle | |
EP3734394A1 (en) | Sensor fusion using inertial and image sensors | |
EP3158417A1 (en) | Sensor fusion using inertial and image sensors | |
EP3158293A1 (en) | Sensor fusion using inertial and image sensors | |
CN112066985B (zh) | 一种组合导航***初始化方法、装置、介质及电子设备 | |
US11669109B2 (en) | Method and apparatus for yaw fusion and aircraft | |
CN110377056B (zh) | 无人机航向角初值选取方法及无人机 | |
CN110325822B (zh) | 云台位姿修正方法和装置 | |
WO2020103049A1 (zh) | 旋转微波雷达的地形预测方法、装置、***和无人机 | |
CN110377058B (zh) | 一种飞行器的偏航角修正方法、装置及飞行器 | |
CN111679680A (zh) | 一种无人机自主着舰方法及*** | |
WO2021168819A1 (zh) | 无人机的返航控制方法和设备 | |
Ariante et al. | UAS for positioning and field mapping using LIDAR and IMU sensors data: Kalman filtering and integration | |
CN109375647A (zh) | 微型多源感知计算*** | |
CN110785722A (zh) | 对移动平台的参数优化方法、装置及控制设备、飞行器 | |
JP2019191888A (ja) | 無人飛行体、無人飛行方法及び無人飛行プログラム | |
Filyashkin et al. | Gyro-accelerometric method of determination of angular orientation parameters | |
Raj et al. | Development of an autonomous flight controller circuit with real time data transmission | |
CN114199220A (zh) | 一种无人机空中在线磁罗盘校准方法和装置 | |
da Paixão et al. | An attitude heading and reference system: Basic concepts and prototype | |
García et al. | A Methodology for Design and Analysis of Sensor Fusion with Real Data in UAV platforms |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20200211 |
|
WD01 | Invention patent application deemed withdrawn after publication |