CN108513610A - 一种云台姿态估计方法、装置以及相应的云台 - Google Patents

一种云台姿态估计方法、装置以及相应的云台 Download PDF

Info

Publication number
CN108513610A
CN108513610A CN201780004424.7A CN201780004424A CN108513610A CN 108513610 A CN108513610 A CN 108513610A CN 201780004424 A CN201780004424 A CN 201780004424A CN 108513610 A CN108513610 A CN 108513610A
Authority
CN
China
Prior art keywords
holder
carrier
attitude
data
attitude 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.)
Pending
Application number
CN201780004424.7A
Other languages
English (en)
Inventor
苏铁
潘立忠
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
SZ DJI Osmo Technology Co Ltd
Original Assignee
SZ DJI Osmo Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by SZ DJI Osmo Technology Co Ltd filed Critical SZ DJI Osmo Technology Co Ltd
Publication of CN108513610A publication Critical patent/CN108513610A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/166Mechanical, construction or arrangement details of inertial navigation systems
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/12Control of position or direction using feedback

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Gyroscopes (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本发明提供了一种云台姿态估计方法、云台估计装置和具有该云台估计装置的云台。所述方法包括:S1、测量云台的角速度值,并基于该角速度值得到测量姿态数据;S2、测量所述云台的载体的运动状态数据,根据该运动状态数据计算载体的参考姿态数据,所述载体支承所述云台;S3、利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。本发明估计云台的姿态时能够有效地处理载体的运动状态对云台的姿态产生的影响,从而能够更为准确地估计云台的姿态,以使得对云台的姿态的控制更为准确。

Description

一种云台姿态估计方法、装置以及相应的云台
版权申明
本专利文件披露的内容包含受版权保护的材料。该版权为版权所有人所有。版权所有人不反对任何人复制专利与商标局的官方记录和档案中所存在的该专利文件或者专利披露。
技术领域
本发明属于自动控制领域,具体设计一种云台姿态估计方法、装置以及相应的云台。
背景技术
目前云台的控制是通过云台上的惯性测量元件测量云台的姿态,并将测量得到的云台的姿态与一个给定的目标姿态进行比较,根据二者的偏差控制三轴电机的动作,以控制实现云台的实时姿态达到目标姿态。
现有技术中测量云台姿态的装置如图1所示。其中,惯性测量元件110主要包含陀螺仪和加速度计。陀螺仪能够进行积分获取得到云台的姿态,但是陀螺仪的各个轴的速度输出都有零偏,该零偏不能完全消除,因此用陀螺仪速度输出积分获得云台的姿态是不准确的。基于此,惯性测量元件110还使用加速度计给定云台的姿态参考。然后,处理器120根据加速度计输出的姿态参考对陀螺积分获取的云台的姿态进行修正,最后获得较为稳定的云台的姿态,并在此基础上做位置输出位置控制和速度控制信号,以控制三轴电机的动作。
图1所示的装置测量云台的姿态时,当在将云台安装于载体上并且载体的运动处于非匀速直线运动时,惯性测量元件110中的加速度计会无法准确测量出载体的运动状态对云台的姿态的影响,从而引起云台的姿态估计错误,导致云台上的镜头拍摄的画面发生倾斜而拍摄不到想要的画面。例如,当云台镜头朝前,载体加速向前行驶时,云台自身的姿态会受载体线加速度的影响而估计错误,导致安装在云台上的镜头会不自主的往下倾斜。或者,当云台镜头朝前,载体急刹车时,云台自身的姿态会受线加速度的影响而估计错误,导致安装在云台上的镜头会不自主的往上倾斜。或者,当云台镜头方向与载体行驶的方向偏离90°,载体加速向前行驶时,云台自身的姿态会受线加速度的影响而估计错误,导致安装在云台上的镜头会不自主的往左倾斜;又或者,当云台镜头方向与载体行驶的方向偏离90°,载体急刹车时,云台自身的姿态会受线加速度的影响而估计错误,导致安装在云台上的镜头会不自主的往右倾斜。
发明内容
本发明的一个方面提供了一种云台姿态估计方法。该方法包括:S1、测量云台的角速度值,并基于该角速度值得到测量姿态数据;S2、测量所述云台的载体的运动状态数据,根据该运动状态数据计算载体的参考姿态数据,所述载体支承所述云台;S3、利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。
本发明的另一个方面提供了一种云台姿态估计装置。该装置包括第一惯性测量元件,用于测量所述云台的角速度值,并基于该角速度值得到测量姿态数据;通信接口,用于获得载体的运动状态数据,所述载体支承所述云台;处理器,用于根据所述载体的运动状态数据计算该载体的参考姿态数据,以及利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。
本发明的另一个方面提供了一种云台,包括上述的云台姿态估计装置。
本发明的云台姿态估计方法、云台姿态估计装置以及云台,估计云台的姿态时能够有效地处理载体的运动状态对云台的姿态产生的影响,从而能够更为准确地估计云台的姿态,以使得对云台的姿态的控制更为准确。
附图说明
为了更完整地理解本发明及其优势,现在将参考结合附图的以下描述,其中:
图1示意性示出了现有技术中测量云台姿态的装置的框图;
图2示意性示出了根据本发明一实施例的云台姿态估计方法的流程图;
图3示意性示出了根据本发明一实施例的云台姿态估计方法中利用参考姿态数据对测量姿态数据进行修正的方法流程图;
图4示意性示出了根据本发明另一实施例的云台姿态估计方法的流程图;
图5示意性示出了根据本发明一实施例的云台姿态估计装置的框图;
图6示意性示出了根据本发明一实施例的云台姿态估计装置的框图;
图7示意性示出了根据本发明一实施例的云台姿态估计装置与云台的载体交互进行云台姿态估计的框图;
图8示意性示出了根据本发明另一实施例的云台姿态估计装置与云台的载体交互进行云台姿态估计的框图;
图9示意性示出了根据本发明一实施例的云台的框图。
具体实施方式
根据结合附图对本发明示例性实施例的以下详细描述,本发明的其它方面、优势和突出特征对于本领域技术人员将变得显而易见。
在本发明中,术语“包括”和“含有”及其派生词意为包括而非限制;术语“或”是包含性的,意为和/或。
在本说明书中,下述用于描述本发明原理的各种实施例只是说明,不应该以任何方式解释为限制发明的范围。参照附图的下述描述用于帮助全面理解由权利要求及其等同物限定的本发明的示例性实施例。下述描述包括多种具体细节来帮助理解,但这些细节应认为仅仅是示例性的。因此,本领域普通技术人员应认识到,在不背离本发明的范围和精神的情况下,可以对本文中描述的实施例进行多种改变和修改。此外,为了清楚和简洁起见,省略了公知功能和结构的描述。此外,贯穿附图,相同附图标记用于相同或相似的功能和步骤。
对于云台姿态估计,本发明主要考虑这样一种情形,即云台安装在一定的载体上,而载体处于非匀速直线运动时,载体的运动状态会对云台的姿态的估计造成偏差。由于此偏差的存在,使得将估计的云台的姿态与目标姿态进行比较后,根据比较结果对云台的姿态的控制会不够准确。在此种情况,如何有效处理载体的运动状态带来的云台的姿态的估计偏差,从而更加准确地估计出云台的姿态,以便实现对云台的姿态的准确控制非常关键。
当云台安装在载体上时,如果将云台和载体作为整体看成是一个质点,则该质点在世界坐标系中的坐标位置变化由载体的运动决定,即云台随着载体的运动在世界坐标系中移动。
与此同时,云台也会相对于载体本身发生平移或旋转。云台的姿态则是在以载体为参照物所构成的本地坐标系中,云台所在的位置以及沿各个方向的旋转角度。例如,可以以该载体上的某一点为坐标原点而定义一个空间三维的本地坐标系,此时,云台的姿态即为在该本地坐标系中的位置、以及云台沿本地坐标系中的三个轴的旋转角度。
根据本发明的实施例,提供了一种云台姿态估计方法。首先测量云台的角速度值,并基于该角速度值得到测量姿态数据。其次,测量所述云台的载体的运动状态数据,根据该运动状态数据计算载体的参考姿态数据,所述载体支承所述云台。最后,利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。根据本发明的实施例,在得到云台的测量姿态数据后,利用与载体的运动状态相关的参考姿态数据对该测量姿态数据进行修正,以消除载体的运动状态对云台的姿态的估计造成的偏差,从而得到更为准确的云台姿态数据,能够更加准确地估计出云台的姿态。
根据本发明的实施例,还提供了一种云台姿态估计装置,包括第一惯性测量元件、通信接口和处理器。其中,第一惯性测量元件用于测量所述云台的角速度值,并基于该角速度值得到测量姿态数据。通信接口,用于获得载体的运动状态数据,所述载体支承所述云台。处理器,用于根据所述载体的运动状态数据计算该载体的参考姿态数据,以及利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。
根据本发明的实施例,还提供了一种云台,该云台包括本发明提供的云台姿态估计装置。该云台的姿态能够得到准确地控制,从而使安装在该云台上的镜头的控制更加准确有效,拍摄得到的画面更加准确。
图2示意性示出了根据本发明一实施例的云台姿态估计方法的流程图。
如图2所示,根据本发明一实施例的云台姿态估计方法包括步骤S210~步骤S230。
首先,在步骤S210,测量云台的角速度值,并基于该角速度值得到测量姿态数据。
具体地,可以通过第一惯性测量元件测量云台的角速度值,并基于该角速度计算云台的测量姿态数据。例如当第一惯性测量元件包括陀螺仪时,可以利用陀螺仪测量云台的角速度值,同时陀螺仪可以进行利用积分获取得到云台的pitch、roll、和yaw三轴方向的姿态。
通常,为获得云台的实时状态以及惯性运动状态数据,第一惯性测量元件直接安装在云台上,构成云台的组成的一部分。
然后,在步骤S220,测量所述云台的载体的运动状态数据,根据该运动状态数据计算载体的参考姿态数据,所述载体支承所述云台。
支持云台的载体可以是飞机、汽车等装置。
载体的运动状态可以是匀速直线运动,或者非匀速直线运动。
载体的运动状态数据可以是,例如载体的线加速度。在此种情况下,当载体的运动状态为匀速直线运动时,载体的线加速度即为零。而当载体的运动状态为非匀速执行运动时,此时测量得到载体的线加速度,并根据该线加速度值得到载体的参考姿态数据。
另外,载体的运动状态数据还可以是,例如,载体曲线运动时的角速度、角加速度、载体的旋转角速度等,基于不同的运动状态数据,可以有不同的计算方法以获取对应的载体的参考姿态数据。
根据测量得到的载体的运动状态数据计算得到载体的参考姿态数据,例如可以将载体的运动状态数据转换为四元数等。
在步骤S230,利用参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。
具体可以是,例如,将参考姿态数据与测量姿态数据进行比较,得到二者之间的小角度误差。对该小角度误差做扩展卡尔曼滤波器(Extended Kalman Filter,EKF)估计,通过EKF估计修正测量姿态数据,从而得到更为准确的云台姿态数据。
根据本发明的实施例的云台姿态估计方法,通过根据载体的运动状态数据得到的载体的参考姿态数据修正云台的测量姿态数据,以消除载体的运动状态对云台的姿态的估计造成的偏差,从而得到更为准确的云台姿态数据,能够更加准确地估计出云台的姿态。
图3示意性示出了根据本发明一实施例的云台姿态估计方法中利用参考姿态数据对测量姿态数据进行修正的方法流程图。
如图3所示,根据本发明一实施例的云台姿态估计方法中,步骤S210中利用参考姿态数据对测量姿态数据进行修正包括步骤S331-1、步骤S331-2和步骤S332。
在步骤331-1,伪造姿态数据。
在步骤331-2,读取云台的三轴关节角度。
在步骤332,基于该三轴关节角度与该伪造姿态数据得到参考姿态数据。
具体地,例如,当云台直接水平安装在载体上,中间不加减震,或安装的减震形变较小,可以利用载体上与云台连接的部位的姿态和编码器数据伪造姿态数据,并根据由伪造姿态数据得到的参考姿态数据来修正云台的测量姿态数据。通过这种方式,能够保证云台的姿态的稳定,从而使云台的不受到载体运动状态的影响。
在步骤S331-1中,伪造姿态数据具体可以是伪造姿态四元数(1000)。
在步骤S331-2中,读取云台的三轴关节角度,包括读取云台的的pitch轴、roll轴、和yaw轴这三个轴的关节角度。
在步骤S332中,可以将读取到的云台的三轴关节角度换算成四元数,并将该四元数与伪造姿态四元数(1000)相乘,从而得到参考姿态数据的四元数。
图4示意性示出了根据本发明另一实施例的云台姿态估计方法的流程图。
如图4所示,根据本发明另一实施例的云台姿态估计方法包括步骤S410、S420和步骤S230。其中,步骤S230与图2中描述的步骤S230一致。
首先,在步骤S410,测量云台的角速度值,并基于该角速度值得到测量姿态数据;并且测量所述云台的加速度值。本步骤S410在测量云台的角速度值的同时,还要测量云台的加速度值。
然后,在步骤S420,测量该云台的载体的运动状态数据,其中,运动状态数据包括载体的线加速度,将该云台的加速度值减去该载体的线加速度得到参考姿态数据。
例如,当云台直接水平安装在载体上,获得载体的线加速度后根据该线加速度得到载体的参考姿态数据,然后从测量姿态数据中减去该参考姿态数据,从而得到更为准确的云台姿态数据。
具体地,载体的线加速度可以由指南针和卫星定位装置测量得到。指南针和卫星定位装置均安装于载体上。GPS用于获得大坐标体系下载体的线加速度,指南针用于测定方向,二者结合可以测量得到载体在云台坐标系下的线加速度。
或者,载体的线加速度也可以由安装在载体上的第二加速度计测量得到。第二加速度计安装在载体上,和载体的运动一致,能够有效地测量载体的线加速度。
根据本发明的实施例,参考姿态数据可以由云台的加速度值减去载体的线加速度得到。其中云台的加速度值可以是通过第一惯性测量元件测量得到,更进一步地,可以是第一测量元件中的第一加速度计测量得到。
由云台的加速度值减去载体的线加速度,剔除了对载体的线加速度对云台的姿态的影响。
最后,在步骤S230,利用步骤430得到的参考姿态数据对测量姿态数据进行修正,得到云台姿态数据。
使用步骤420得到的参考姿态数据对云台的测量姿态数据修正,能够有效地消除载体的线加速度对云台的姿态的估计造成的偏差,从而得到更为准确的云台姿态数据。
根据本发明的实施例的云台姿态估计方法中,云台包括第一惯性测量元件,云台的角速度值由第一惯性测量元件测量得到。进一步地,第一惯性测量元件可以包括陀螺仪。
陀螺仪是用高速回转体的动量矩敏感壳体相对惯性空间绕正交于自转轴的一个或二个轴的角运动检测装置,以及利用其原理制成的角运动检测装置,能够准确有效的测量云台的角速度值。
并且陀螺仪还可以对测量得到的角速度值进行积分,输出云台的pitch、roll、和yaw三轴方向的姿态。
另外,第一惯性测量元件还可以包括第一加速度计,可以用来测量云台的加速度值。
根据本发明的实施例的云台姿态估计方法中,载体可以包括第二惯性测量元件,可以使用第二惯性测量元件测量载体的运动状态数据。例如,当测量载体的线加速度时使用的第二加速度计就属于第二惯性测量元件。
图5示意性示出了根据本发明一实施例的云台姿态估计装置的框图。
如图5所示,根据本发明一实施例的云台姿态估计装置500包括第一惯性测量元件包括第一惯性测量元件510,通信接口520和处理器530。
第一惯性测量元件510用于测量云台的角速度值,并基于该角速度值得到测量姿态数据。
通信接口520用于获得载体的运动状态数据,其中该载体支承该云台。
处理器530用于根据载体的运动状态数据计算该载体的参考姿态数据,以及利用该参考姿态数据对测量姿态数据进行修正,得到云台姿态数据。
第一惯性测量元件510测量云台的角速度值,并基于该角速度计算云台的测量姿态数据。具体地,例如,当第一惯性测量元件包括陀螺仪时,可以利用陀螺仪测量云台的角速度值,同时陀螺仪可以进行利用积分获取得到云台的pitch、roll、和yaw三轴方向的姿态。
通信接口520获得的载体的运动状态数据可以是,例如载体的线加速度、载体曲线运动时的角速度、角加速度、载体的旋转角速度等。
处理器530根据载体的运动状态数据计算该载体的参考姿态数据,包括基于不同的运动状态数据,根据不同的计算方法以获取对应的载体的参考姿态数据,例如,可以将载体的运动状态数据转换为四元数等。
处理器530还利用该参考姿态数据对测量姿态数据进行修正,得到云台姿态数据。具体可以是,例如,将参考姿态数据与测量姿态数据进行比较,得到二者之间的小角度误差。对该小角度误差做扩展卡尔曼滤波器(Extended Kalman Filter,EKF)估计,通过EKF估计修正测量姿态数据,从而得到更为准确的云台姿态数据。
根据本发明的实施例,云台姿态估计装置500利用获取的载体的运动状态数据载体的参考姿态数据,并使用该载体的参考姿态数据修正云台的测量姿态数据,以消除载体的运动状态对云台的姿态的估计造成的偏差,从而得到更为准确的云台姿态数据,能够更加准确地估计出云台的姿态。
根据本发明的实施例,当通信接口520获得的载体的运动状态数据包括云台的三轴关节角度时,处理器530还用于建立伪造姿态数据,并基于云台的三轴关节角度与该伪造姿态数据得到参考姿态数据。
例如,处理器530建立的伪造姿态数据可以是伪造姿态四元数(1000)。
同时,处理器530基于云台的三轴关节角度与该伪造姿态数据得到参考姿态数据,可以是将云台的三轴关节角度换算成四元数,并将该四元数与伪造姿态四元数(1000)相乘,从而得到云台的参考姿态数据的四元数。
最后,处理器530根据得到的该参考姿态数据的四元数对云台的测量姿态数据进行修正,从而得到云台姿态数据。
图6示意性示出了根据本发明另一实施例的云台姿态估计装置的框图。
如图6所示,根据本发明另一实施例的云台姿态估计装置500包括第一惯性测量元件包括第一惯性测量元件510,通信接口520和处理器530。
其中第一惯性测量元件510还包括陀螺仪511。
陀螺仪511是用高速回转体的动量矩敏感壳体相对惯性空间绕正交于自转轴的一个或二个轴的角运动检测装置,以及利用其原理制成的角运动检测装置,能够准确有效的测量云台的角速度值。
陀螺仪511还可以对测量得到的角速度值进行积分,输出云台的pitch、roll、和yaw三轴方向的姿态。
第一惯性测量元件510还可以包括第一加速度计512。
第一加速度计512可以测量获得云台的加速度值。
图7示意性示出了根据本发明一实施例的云台姿态估计装置与云台的载体交互进行云台姿态估计的框图。
如图7所示,云台姿态估计装置500包括第一惯性测量元件包括第一惯性测量元件510,通信接口520和处理器530。其中第一惯性测量元件510还包括陀螺仪511和第一加速度计512。
云台姿态估计装置500的通信接口520从载体700中获取载体的运动状态数据。更具体地,载体的运动状态数包括载体的线加速度,由载体上的GPS和指南针710测量得到后,传输云台姿态估计装置500的通信接口520。
陀螺仪511测量得到云台的角速度值,并进行积分得到云台的测量姿态数据,传输至处理器530。
第一加速度计512测量得到云台的加速度值,并传输至处理器530。
GPS和指南针710测量得到载体的线加速度,并由通信接口520传输至处理器530。
处理器530将云台的加速度值减去载体的线加速度,得到参考姿态数据。并根据该参考姿态数据对云台的测量姿态数据进行修正,得到云台姿态数据。
处理器530得到的参考姿态数据由云台的加速度值减去载体的线加速度得到,从而消除载体的运动状态对云台的姿态的估计造成的偏差。以此参考姿态数据对测量姿态数据进行修正后,能够得到更为准确的云台姿态数据,能够更加准确地估计出云台的姿态。
图8示意性示出了根据本发明另一实施例的云台姿态估计装置与云台的载体交互进行云台姿态估计的框图。
如图8所示,与图7不同的是,云台姿态估计装置500通信接口520从载体800中获取载体的运动状态数据。并且载体的运动状态由载体上的第二惯性测量元件810测量得到。第二惯性测量元件810包括第二陀螺仪811和第二加速度计812。
第二陀螺仪811测量载体的角速度值,并传输给云台姿态估计装置500的通信接口520。
第二加速度计820测量得到载体的线加速度,并由通信接口520传输至处理器530。
处理器530将云台的加速度值减去载体的线加速度,得到参考姿态数据。并根据该参考姿态数据对云台的测量姿态数据进行修正,得到云台姿态数据。
处理器530得到的参考姿态数据由云台的加速度值减去载体的线加速度得到,从而消除载体的运动状态对云台的姿态的估计造成的偏差。以此参考姿态数据对测量姿态数据进行修正后,能够得到更为准确的云台姿态数据,能够更加准确地估计出云台的姿态。
图9示意性示出了根据本发明一实施例的云台的框图。
如图9所示,云台900包括云台姿态估计装置500。云台的其它部分,本发明不作限制。例如,作为一种具体实施方式,云台还包括云台本体,所述云台姿态估计装置500安装于云台本体。
其中云台姿态估计装置500的结构可以参考图5~图7中的描述。云台的其他部件或结构可以根据实际需要设定,例如,对于云台本身的结构和功能,可以采用现有的任何结构并实现任意其他功能,本发明中不作限制。
并且,云台姿态估计装置500在进行云台姿态估计时,可以实现参考图2~图4所描述的方法来得到云台姿态数据,从而使得该云台900的姿态能够得到准确地控制,使安装在该云台上的镜头的控制更加准确有效,拍摄得到的画面更加准确。
尽管已经参照本发明的特定示例性实施例示出并描述了本发明,但是本领域技术人员应该理解,在不背离所附权利要求及其等同物限定的本发明的精神和范围的情况下,可以对本发明进行形式和细节上的多种改变。因此,本发明的范围不应该限于上述实施例,而是应该不仅由所附权利要求来进行确定,还由所附权利要求的等同物来进行限定。

Claims (17)

1.一种云台姿态估计方法,该方法包括:
S1、测量云台的角速度值,并基于该角速度值得到测量姿态数据;
S2、测量所述云台的载体的运动状态数据,根据该运动状态数据计算载体的参考姿态数据,所述载体支承所述云台;
S3、利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。
2.根据权利要求1所述的云台姿态估计方法,其中,步骤S2包括:
伪造姿态数据;
读取云台的三轴关节角度;
基于所述三轴关节角度与所述伪造姿态数据得到所述参考姿态数据。
3.根据权利要求1所述的云台姿态估计方法,其中,所述运动状态数据包括载体的线加速度;
步骤S1还包括:测量所述云台的线加速度;
步骤S2中计算载体的参考姿态数据包括:将所述云台的加速度值减去所述载体的线加速度得到所述参考姿态数据;
4.根据权利要求3所述的云台姿态估计方法,其中,
所述载体的线加速度由指南针与卫星定位装置测量得到。
5.根据权利要求3所述的云台姿态估计方法,其中,
所述载体的线加速度由第二加速度计测量得到。
6.如权利要求1至5中任一项所述的云台姿态估计方法,其中,所述云台包括第一惯性测量元件:
所述云台的角速度值由第一惯性测量元件测量得到;并且/或者
所述第一惯性测量元件包括陀螺仪。
7.如权利要求3至5中任一项所述的云台姿态估计方法,其中,所述云台包括第一惯性测量元件:
所述云台的角速度值和加速度值由第一惯性测量元件测量得到;并且/或者
所述第一惯性测量元件包括陀螺仪和/或第一加速度计。
8.如权利要求5所述的云台姿态估计方法,其中,所述载体包括第二惯性测量元件,所述第二加速度计属于该第二惯性测量元件。
9.一种云台姿态估计装置,包括:
第一惯性测量元件,用于测量所述云台的角速度值,并基于该角速度值得到测量姿态数据;
通信接口,用于获得载体的运动状态数据,所述载体支承所述云台;
处理器,用于根据所述载体的运动状态数据计算该载体的参考姿态数据,以及利用所述参考姿态数据对所述测量姿态数据进行修正,得到云台姿态数据。
10.根据权利要求9所述的云台姿态估计装置,其中,所述载体的运动状态数据为三轴关节角度,所述处理器还用于:
建立伪造姿态数据;
基于所述三轴关节角度与所述伪造姿态数据得到素数参考姿态数据。
11.根据权利要求10所述的云台姿态估计装置,其中,
所述第一惯性测量元件还用于测量所述云台的加速度值;
所述通信接口获得的载体的运动状态数据包括载体的线加速度;
所述处理器用于将所述云台的加速度值减去所述载体的线加速度得到所述参考姿态数据。
12.如权利要求9至11中任一项所述的云台姿态估计装置,所述第一惯性测量元件包括陀螺仪。
13.如权利要求11所述的云台姿态估计装置,所述第一惯性测量元件包括陀螺仪和第一加速度计。
14.一种云台,包括云台本体以及安装于所述云台本体的云台姿态估计装置,所述云台姿态估计装置包括:
第一惯性测量元件,用于测量所述云台的角速度值,并基于该角速度值得到测量姿态数据;
通信接口,用于获得载体的运动状态数据,所述载体支承所述云台;
处理器,用于根据所述载体的运动状态数据计算该载体的参考姿态数据。
15.根据权利要求14所述的云台,其中,所述载体的运动状态数据为三轴关节角度,所述处理器还用于:
建立伪造姿态数据;
基于所述三轴关节角度与所述伪造姿态数据得到素数参考姿态数据。
16.根据权利要求15所述的云台,其中,
所述第一惯性测量元件还用于测量所述云台的加速度值;
所述通信接口获得的载体的运动状态数据包括载体的线加速度;
所述处理器用于将所述云台的加速度值减去所述载体的线加速度得到所述参考姿态数据。
17.如权利要求14至16中任一项所述的云台,所述第一惯性测量元件包括陀螺仪。
CN201780004424.7A 2017-04-21 2017-04-21 一种云台姿态估计方法、装置以及相应的云台 Pending CN108513610A (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2017/081442 WO2018191957A1 (zh) 2017-04-21 2017-04-21 一种云台姿态估计方法、装置以及相应的云台

Publications (1)

Publication Number Publication Date
CN108513610A true CN108513610A (zh) 2018-09-07

Family

ID=63375200

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201780004424.7A Pending CN108513610A (zh) 2017-04-21 2017-04-21 一种云台姿态估计方法、装置以及相应的云台

Country Status (2)

Country Link
CN (1) CN108513610A (zh)
WO (1) WO2018191957A1 (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110770671A (zh) * 2018-09-30 2020-02-07 深圳市大疆创新科技有限公司 云台及其控制方法、可移动平台
WO2020062281A1 (zh) * 2018-09-30 2020-04-02 深圳市大疆创新科技有限公司 云台的控制方法、云台、可移动平台及可读存储介质
CN113848999A (zh) * 2021-12-01 2021-12-28 普宙科技(深圳)有限公司 一种云台正反倒置自适应控制方法、装置及云台

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110296684B (zh) * 2019-06-03 2023-04-11 新纳传感系统有限公司 一种具有快速线加速度检测功能的动态倾角计
CN114869604B (zh) * 2022-05-07 2023-07-11 江苏理工学院 物联网轮椅智能导航系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102564416A (zh) * 2011-12-30 2012-07-11 浙江国自机器人技术有限公司 一种镜面清洁机器人进行三维重构与定位的系统及方法
CN102707734A (zh) * 2012-06-19 2012-10-03 上海大学 基于惯性姿态传感器的自稳定云台
CN105045293A (zh) * 2015-05-27 2015-11-11 深圳一电科技有限公司 云台控制方法、外部载体控制方法及云台
CN105588562A (zh) * 2015-12-16 2016-05-18 北京理工大学 一种旋转调制惯性导航系统中隔离载体角运动的方法
KR20160087277A (ko) * 2015-01-13 2016-07-21 아주대학교산학협력단 클라우드 플랫폼에 기반한 교통안전 정보 제공 시스템 및 그것을 이용한 교통안전 정보 제공 방법
CN106289244A (zh) * 2016-08-10 2017-01-04 极翼机器人(上海)有限公司 一种抗加速度干扰的姿态确定方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5922039A (en) * 1996-09-19 1999-07-13 Astral, Inc. Actively stabilized platform system
CN101403848A (zh) * 2008-11-14 2009-04-08 天津市联大通讯发展有限公司 三维自动稳定摄像系统
CN104881033B (zh) * 2015-03-27 2018-09-04 深圳市大疆灵眸科技有限公司 云台控制系统、云台控制方法及无人飞行器
CN205176664U (zh) * 2015-08-25 2016-04-20 深圳市大疆创新科技有限公司 手持云台

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102564416A (zh) * 2011-12-30 2012-07-11 浙江国自机器人技术有限公司 一种镜面清洁机器人进行三维重构与定位的系统及方法
CN102707734A (zh) * 2012-06-19 2012-10-03 上海大学 基于惯性姿态传感器的自稳定云台
KR20160087277A (ko) * 2015-01-13 2016-07-21 아주대학교산학협력단 클라우드 플랫폼에 기반한 교통안전 정보 제공 시스템 및 그것을 이용한 교통안전 정보 제공 방법
CN105045293A (zh) * 2015-05-27 2015-11-11 深圳一电科技有限公司 云台控制方法、外部载体控制方法及云台
CN105588562A (zh) * 2015-12-16 2016-05-18 北京理工大学 一种旋转调制惯性导航系统中隔离载体角运动的方法
CN106289244A (zh) * 2016-08-10 2017-01-04 极翼机器人(上海)有限公司 一种抗加速度干扰的姿态确定方法

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110770671A (zh) * 2018-09-30 2020-02-07 深圳市大疆创新科技有限公司 云台及其控制方法、可移动平台
WO2020062298A1 (zh) * 2018-09-30 2020-04-02 深圳市大疆创新科技有限公司 云台及其控制方法、可移动平台
WO2020062281A1 (zh) * 2018-09-30 2020-04-02 深圳市大疆创新科技有限公司 云台的控制方法、云台、可移动平台及可读存储介质
CN111656298A (zh) * 2018-09-30 2020-09-11 深圳市大疆创新科技有限公司 云台的控制方法、云台、可移动平台及可读存储介质
CN113848999A (zh) * 2021-12-01 2021-12-28 普宙科技(深圳)有限公司 一种云台正反倒置自适应控制方法、装置及云台

Also Published As

Publication number Publication date
WO2018191957A1 (zh) 2018-10-25

Similar Documents

Publication Publication Date Title
CN108513610A (zh) 一种云台姿态估计方法、装置以及相应的云台
Shen et al. Optical Flow Sensor/INS/Magnetometer Integrated Navigation System for MAV in GPS‐Denied Environment
WO2017107434A1 (zh) 一种基于单天线的gnss-ins车辆定姿方法
Allotta et al. Single axis FOG aided attitude estimation algorithm for mobile robots
CN101413800A (zh) 导航/稳瞄一体化系统的导航、稳瞄方法
CN107990901B (zh) 一种基于传感器的用户方向定位方法
CN102937450B (zh) 一种基于陀螺测量信息的相对姿态确定方法
JP2012173190A (ja) 測位システム、測位方法
CN110221302A (zh) 环境探测装置及其修正方法、系统、便携设备及存储介质
CN106643802A (zh) 一种陀螺仪漂移校正方法及装置
JP2014240266A (ja) センサドリフト量推定装置及びプログラム
Liu et al. Development of a low-cost IMU by using sensor fusion for attitude angle estimation
Ding et al. Adding optical flow into the GPS/INS integration for UAV navigation
CN108627152A (zh) 一种微型无人机基于多传感器数据融合的导航方法
JP5511088B2 (ja) 自律測位に用いる重力ベクトルを補正する携帯装置、プログラム及び方法
CN104121930B (zh) 一种基于加表耦合的mems陀螺漂移误差的补偿方法
CN103968848A (zh) 一种基于惯性传感器的导航方法及导航系统
Li et al. Unmanned aerial vehicle position estimation augmentation using optical flow sensor
CN109752749B (zh) 一种高旋飞行器低旋部件的姿态估计方法及系统
Zha et al. A rotating inertial navigation system with the rotating axis error compensation consisting of fiber optic gyros
Reinstein Evaluation of fine alignment algorithm for inertial navigation
Chen et al. Target tracking system based on inertial stabilized platform
Zhou et al. A fusion attitude determination method based on quaternion for MEMS gyro/accelerometer/magnetometer
Wu et al. A study of low-cost attitude and heading reference system under high magnetic interference
CN103743379A (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
RJ01 Rejection of invention patent application after publication

Application publication date: 20180907

RJ01 Rejection of invention patent application after publication