CN108801260B - 基于水下机器人的数据处理方法及装置 - Google Patents
基于水下机器人的数据处理方法及装置 Download PDFInfo
- Publication number
- CN108801260B CN108801260B CN201810426447.3A CN201810426447A CN108801260B CN 108801260 B CN108801260 B CN 108801260B CN 201810426447 A CN201810426447 A CN 201810426447A CN 108801260 B CN108801260 B CN 108801260B
- Authority
- CN
- China
- Prior art keywords
- underwater
- real
- data
- angle
- attitude
- 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/20—Instruments for performing navigational calculations
-
- 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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- 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/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Navigation (AREA)
Abstract
本申请公开了一种基于水下机器人的数据处理方法及装置。该方法包括:通过感应装置,得到水下第一姿态角数据;对所述水下第一姿态角数据进行数据融合,得到第一水下实时姿态;根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态;采用通过感应装置得到水下第一姿态角数据的方式,通过对所述水下第一姿态角数据进行数据融合得到第一水下实时姿态,达到了根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正的目的,从而实现了得到矫正后的第二水下实时姿态的技术效果,进而解决了相关技术中进行姿态数据处理时过程复杂,导致处理效率低下的问题。
Description
技术领域
本申请涉及水下数据处理领域,具体而言,涉及一种基于水下机器人的数据处理方法及装置。
背景技术
卡尔曼滤波是一个最优化自回归数据处理算法。近年来被广泛应用于计算机图像处理方面,在水下机器人控制系统中,需要对陀螺仪、加速度传感器和磁力计传感器所测得的数据进行综合和校正,如果使用简单的均值滤波,很难满足精度和实时性上的要求,故通过卡尔曼滤波将加速度传感器和陀螺仪的数据进行融合,在计算水下无人机的实时姿态时很好地抑制了噪声的干扰作用,以提高测量精度。
发明人发现,应用卡尔曼滤波算法进行姿态数据融合,运算量非常大,对控板的处理器芯片要求非常高,所以对于应用在水下机器人姿态数据处理方法进行简化就显得非常必要。
因此急需一种基于水下机器人的数据处理方法及装置,以解决相关技术中进行姿态数据处理时过程复杂,导致处理效率低下的问题。
发明内容
本申请的主要目的在于提供一种基于水下机器人的数据处理方法及装置,以解决相关技术中进行姿态数据处理时过程复杂,导致处理效率低下的问题。
为了实现上述目的,根据本申请的一个方面,提供了一种基于水下机器人的数据处理方法。
根据本申请的基于水下机器人的数据处理方法包括:通过感应装置,得到水下第一姿态角数据,其中,所述水下第一姿态角数据用于作为卡尔曼滤波方程式中的计算因子;对所述水下第一姿态角数据进行数据融合,得到第一水下实时姿态,其中,所述第一水下实时姿态用于作为经过卡尔曼滤波方程式计算后的所述水下机器人在坐标系中的每个轴向上的角度;根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态。
进一步的,所述根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态包括:通过设置于所述水下机器人上的磁力传感器,得到第一参照角度;根据所述第一参照角度,对所述第一水下实时姿态中的每个轴向角度进行矫正处理,得到矫正后的所述第二水下实时姿态。
进一步的,所述通过感应装置,得到水下第一姿态角数据包括:通过设置于所述水下机器人上的加速度传感器,得到第一观测方程式计算因子。
进一步的,所述通过感应装置,得到水下第一姿态角数据还包括:通过设置于所述水下机器人上的陀螺仪传感器,得到第一状态方程式计算因子。
进一步的,所述对所述水下第一姿态角数据进行数据融合,得到第一水下实时姿态包括:根据所述第一观测方程式计算因子和所述第一状态方程式计算因子,构建得到第一卡尔曼滤波方程组;根据所述第一卡尔曼滤波方程组,得到所述第一水下实时姿态。
进一步的,所述根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态之后包括:建立大地坐标系;根据所述大地坐标系和所述第二水下实时姿态所对应的机器坐标系,得到第一转换矩阵;根据所述第一转换矩阵,得到第三实时姿态。
进一步的,所述根据所述第一转换矩阵,得到第三实时姿态包括:根据所述第一转换矩阵,将所述机器坐标系中的每个轴向上的角度换算为所述大地坐标系中每个轴向上的角度。
为了实现上述目的,根据本申请的另一方面,提供了一种基于水下机器人的数据处理装置。
根据本申请的基于水下机器人的数据处理装置包括:感应单元,用于通过感应装置,得到水下第一姿态角数据;融合单元,用于对所述水下第一姿态角数据进行数据融合,得到第一水下实时姿态;矫正单元,用于根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态。
进一步的,所述感应单元包括:加速度感应模块,用于通过设置于所述水下机器人上的加速度传感器,得到第一观测方程式计算因子;陀螺仪感应模块,用于通过设置于所述水下机器人上的陀螺仪传感器,得到第一状态方程式计算因子。
进一步的,所述矫正单元包括:参照数据获取模块,用于通过设置于所述水下机器人上的磁力传感器,得到第一参照角度;矫正处理模块,用于根据所述第一参照角度,对所述第一水下实时姿态中的每个轴向角度进行矫正处理,得到矫正后的所述第二水下实时姿态。
在本申请实施例中,采用通过感应装置得到水下第一姿态角数据的方式,通过对所述水下第一姿态角数据进行数据融合得到第一水下实时姿态,达到了根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正的目的,从而实现了得到矫正后的第二水下实时姿态的技术效果,进而解决了相关技术中进行姿态数据处理时过程复杂,导致处理效率低下的问题。
附图说明
构成本申请的一部分的附图用来提供对本申请的进一步理解,使得本申请的其它特征、目的和优点变得更明显。本申请的示意性实施例附图及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1是根据本发明第一实施例所述的数据处理方法示意图;
图2是根据本发明第二实施例所述的数据处理方法示意图;
图3是根据本发明第三实施例所述的数据处理方法示意图;
图4是根据本发明第四实施例所述的数据处理方法示意图;
图5是根据本发明第一实施例所述的数据处理装置示意图;
图6是根据本发明所述的感应单元示意图;以及
图7是根据本发明所述的矫正单元示意图。
具体实施方式
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分的实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本申请保护的范围。
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本申请的实施例。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
在本申请中,术语“上”、“下”、“左”、“右”、“前”、“后”、“顶”、“底”、“内”、“外”、“中”、“竖直”、“水平”、“横向”、“纵向”等指示的方位或位置关系为基于附图所示的方位或位置关系。这些术语主要是为了更好地描述本发明及其实施例,并非用于限定所指示的装置、元件或组成部分必须具有特定方位,或以特定方位进行构造和操作。
并且,上述部分术语除了可以用于表示方位或位置关系以外,还可能用于表示其他含义,例如术语“上”在某些情况下也可能用于表示某种依附关系或连接关系。对于本领域普通技术人员而言,可以根据具体情况理解这些术语在本发明中的具体含义。
此外,术语“安装”、“设置”、“设有”、“连接”、“相连”、“套接”应做广义理解。例如,可以是固定连接,可拆卸连接,或整体式构造;可以是机械连接,或电连接;可以是直接相连,或者是通过中间媒介间接相连,又或者是两个装置、元件或组成部分之间内部的连通。对于本领域普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。
如图1所示,该方法包括如下的步骤S101至步骤S103:
步骤S101,通过感应装置,得到水下第一姿态角数据,其中,所述水下第一姿态角数据用于作为卡尔曼滤波方程式中的计算因子。
优选的,所述感应装置为设置于所述水下机器人上的三轴陀螺仪传感器、三轴磁力传感器和三轴加速度传感器,统称九轴传感器,在本申请的其他实施例中,所述感应装置也可以是其他可以用于感应角度、角速度、重力、惯性等属性的装置。
优选的,所述卡尔曼滤波是一个最优化自回归数据处理算法,通过平均加权处理,能够将多组数据计算得到一组最准确的数据,具体的,所述卡尔曼滤波方式组中最重要的为观测方程式和状态方程式,所述第一姿态角数据用于作为所述观测方程式或所述状态方程式的计算因子。
优选的,所述第一姿态角数据为由所述三轴陀螺仪传感器感应得到的角速度和/或由所述三轴加速度传感器感应得到的姿态角,所述姿态角包括但不限于:滚动角、俯仰角、偏航角。
步骤S102,对所述水下第一姿态角数据进行数据融合,得到第一水下实时姿态。
优选的,所述第一水下实时姿态用于作为经过卡尔曼滤波方程式计算后的所述水下机器人在坐标系中的每个轴向上的角度,所述第一水下实时姿态能够实时反映所述水下机器人在基于自身机器坐标系中每个轴向的角度。
具体的,将所述三轴陀螺仪传感器感应得到的角速度作为状态向量,并以此构建状态方程式用于后续计算;将所述三轴加速度传感器感应得到的姿态角作为观测值,并以此构建观测方程式用于后续计算。
步骤S103,根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态。
优选的,所述第一水下参照角数据为通过设置于所述水下机器人上的磁力传感器感应得到的大地磁场中的正北方向的角度,并以所述正北角度为参照角度,对经过卡尔曼滤波方程组处理后的角度数据进行校对、矫正,并得到经过矫正后的准确的角度数据(即所述第二水下实时姿态)。
从以上的描述中,可以看出,本发明实现了如下技术效果:
在本申请实施例中,采用通过感应装置得到水下第一姿态角数据的方式,通过对所述水下第一姿态角数据进行数据融合得到第一水下实时姿态,达到了根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正的目的,从而实现了得到矫正后的第二水下实时姿态的技术效果,进而解决了相关技术中进行姿态数据处理时过程复杂,导致处理效率低下的问题。
根据本发明实施例,作为本实施例中的优选,如图2所示,所述根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态包括如下的步骤S201至步骤S202:
步骤S201,通过设置于所述水下机器人上的磁力传感器,得到第一参照角度。
优选的,通过设置于所述水下机器人上的磁力传感器感应得到的大地磁场中的正北方向的角度,并以所述正北角度为参照角度(即所述第一参照角度)。
步骤S202,根据所述第一参照角度,对所述第一水下实时姿态中的每个轴向角度进行矫正处理,得到矫正后的所述第二水下实时姿态。
优选的,对经过卡尔曼滤波方程组处理后的角度数据进行校对、矫正,并得到经过矫正后的准确的角度数据(即所述第二水下实时姿态)。
根据本发明实施例,作为本实施例中的优选,所述通过感应装置,得到水下第一姿态角数据包括:通过设置于所述水下机器人上的加速度传感器,得到第一观测方程式计算因子。
优选的,所述加速度传感器为三轴加速度传感器,为九轴传感器的组成部分,将所述三轴加速度传感器感应得到的姿态角作为观测值,并以此构建观测方程式用于后续计算。
根据本发明实施例,作为本实施例中的优选,所述通过感应装置,得到水下第一姿态角数据还包括:通过设置于所述水下机器人上的陀螺仪传感器,得到第一状态方程式计算因子。
优选的,所述陀螺仪传感器为三轴陀螺仪传感器,为九轴传感器的组成部分,将所述三轴陀螺仪传感器感应得到的角速度作为状态向量,并以此构建状态方程式用于后续计算。
根据本发明实施例,作为本实施例中的优选,如图3所示,所述对所述水下第一姿态角数据进行数据融合,得到第一水下实时姿态包括如下的步骤S301至步骤S302:
步骤S301,根据所述第一观测方程式计算因子和所述第一状态方程式计算因子,构建得到第一卡尔曼滤波方程组。
优选的,所述卡尔曼滤波是一个最优化自回归数据处理算法,通过平均加权处理,能够将多组数据计算得到一组最准确的数据,具体的,所述卡尔曼滤波方式组中最重要的为观测方程式和状态方程式,所述第一姿态角数据用于作为所述观测方程式或所述状态方程式的计算因子。
步骤S302,根据所述第一卡尔曼滤波方程组,得到所述第一水下实时姿态。
优选的,所述第一水下实时姿态用于作为经过所述第一卡尔曼滤波方程组计算后的所述水下机器人在坐标系中的每个轴向上的角度,所述第一水下实时姿态能够实时反映所述水下机器人在基于自身机器坐标系中每个轴向的角度。
根据本发明实施例,作为本实施例中的优选,如图4所示,所述根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态之后包括如下的步骤S401至步骤S403:
步骤S401,建立大地坐标系;
优选的,所述大地坐标系是大地测量中以参考椭球面为基准面建立起来的坐标系,地面点的位置用大地经度、大地纬度和大地高度表示,大地坐标系的确立包括选择一个椭球、对椭球进行定位和确定大地起算数据。
步骤S402,根据所述大地坐标系和所述第二水下实时姿态所对应的机器坐标系,得到第一转换矩阵;
优选的,所述机器坐标系为以所述水下机器人自身为中心建立的三维坐标系,经过卡尔曼滤波方程组数据融合后的所述第一实时姿态为基于所述机器坐标系各个轴向上的角度数据,由于缺乏唯一参照角度,因此很难准确反映所述水下机器人的实时姿态。
具体的,依据所述大地坐标系与所述机器坐标系的相对位置关系,计算得到所述第一转换矩阵。
步骤S403,根据所述第一转换矩阵,得到第三实时姿态。
优选的,将基于所述机器坐标系的每个轴向上的角度(即所述第二实时姿态)与所述第一转换矩阵进行积分相乘,得到的结果即基于所述大地坐标系的每个轴向上的角度(即所述第三实时姿态)。
需要说明的是,在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行,并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
根据本发明实施例,还提供了一种用于实施上述数据处理方法的装置,如图5所示,该装置包括:感应单元10,用于通过感应装置,得到水下第一姿态角数据;融合单元20,用于对所述水下第一姿态角数据进行数据融合,得到第一水下实时姿态;矫正单元30,用于根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态。
根据本发明实施例,作为本实施例中的优选,所述感应单元10用于通过感应装置,得到水下第一姿态角数据,优选的,所述感应装置为设置于所述水下机器人上的三轴陀螺仪传感器、三轴磁力传感器和三轴加速度传感器,统称九轴传感器,在本申请的其他实施例中,所述感应装置也可以是其他可以用于感应角度、角速度、重力、惯性等属性的装置。
根据本发明实施例,作为本实施例中的优选,所述融合单元20用于对所述水下第一姿态角数据进行数据融合,得到第一水下实时姿态,优选的,所述第一水下实时姿态用于作为经过卡尔曼滤波方程式计算后的所述水下机器人在坐标系中的每个轴向上的角度,所述第一水下实时姿态能够实时反映所述水下机器人在基于自身机器坐标系中每个轴向的角度。
根据本发明实施例,作为本实施例中的优选,所述矫正单元30用于根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态,优选的,所述第一水下参照角数据为通过设置于所述水下机器人上的磁力传感器感应得到的大地磁场中的正北方向的角度,并以所述正北角度为参照角度,对经过卡尔曼滤波方程组处理后的角度数据进行校对、矫正,并得到经过矫正后的准确的角度数据(即所述第二水下实时姿态)。
根据本发明实施例,作为本实施例中的优选,如图6所示,所述感应单元10包括:加速度感应模块11,用于通过设置于所述水下机器人上的加速度传感器,得到第一观测方程式计算因子;陀螺仪感应模块12,用于通过设置于所述水下机器人上的陀螺仪传感器,得到第一状态方程式计算因子。
根据本发明实施例,作为本实施例中的优选,所述加速度感应模块11用于通过设置于所述水下机器人上的加速度传感器,得到第一观测方程式计算因子,优选的,所述加速度传感器为三轴加速度传感器,为九轴传感器的组成部分,将所述三轴加速度传感器感应得到的姿态角作为观测值,并以此构建观测方程式用于后续计算。
根据本发明实施例,作为本实施例中的优选,所述陀螺仪感应模块12用于通过设置于所述水下机器人上的陀螺仪传感器,得到第一状态方程式计算因子,优选的,所述陀螺仪传感器为三轴陀螺仪传感器,为九轴传感器的组成部分,将所述三轴陀螺仪传感器感应得到的角速度作为状态向量,并以此构建状态方程式用于后续计算。
根据本发明实施例,作为本实施例中的优选,如图7所示,所述矫正单元30包括:参照数据获取模块31,用于通过设置于所述水下机器人上的磁力传感器,得到第一参照角度;矫正处理模块32,用于根据所述第一参照角度,对所述第一水下实时姿态中的每个轴向角度进行矫正处理,得到矫正后的所述第二水下实时姿态。
根据本发明实施例,作为本实施例中的优选,参照数据获取模块31用于通过设置于所述水下机器人上的磁力传感器,得到第一参照角度,优选的,通过设置于所述水下机器人上的磁力传感器感应得到的大地磁场中的正北方向的角度,并以所述正北角度为参照角度(即所述第一参照角度)。
根据本发明实施例,作为本实施例中的优选,矫正处理模块32用于根据所述第一参照角度,对所述第一水下实时姿态中的每个轴向角度进行矫正处理,得到矫正后的所述第二水下实时姿态,优选的,对经过卡尔曼滤波方程组处理后的角度数据进行校对、矫正,并得到经过矫正后的准确的角度数据(即所述第二水下实时姿态)。
显然,本领域的技术人员应该明白,上述的本发明的各模块或各步骤可以用通用的计算装置来实现,它们可以集中在单个的计算装置上,或者分布在多个计算装置所组成的网络上,可选地,它们可以用计算装置可执行的程序代码来实现,从而,可以将它们存储在存储装置中由计算装置来执行,或者将它们分别制作成各个集成电路模块,或者将它们中的多个模块或步骤制作成单个集成电路模块来实现。这样,本发明不限制于任何特定的硬件和软件结合。
以上所述仅为本申请的优选实施例而已,并不用于限制本申请,对于本领域的技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。
Claims (4)
1.一种基于水下机器人的数据处理方法,其特征在于,用于对水下机器人采集到的水下感应数据进行数据处理,所述方法包括:
通过感应装置,得到水下第一姿态角数据;
其中,通过设置于所述水下机器人上的加速度传感器,得到第一观测方程式计算因子;通过设置于所述水下机器人上的陀螺仪传感器,得到第一状态方程式计算因子;
对所述水下第一姿态角数据进行数据融合,得到第一水下实时姿态;
其中,根据所述第一观测方程式计算因子和所述第一状态方程式计算因子,建立得到第一卡尔曼滤波方程组,根据所述第一卡尔曼滤波方程组,得到所述第一水下实时姿态;所述第一水下实时姿态用于作为经过第一卡尔曼滤波方程组计算后的所述水下机器人在基于自身机器坐标系中的每个轴向上的角度,所述机器坐标系为所述水下机器人自身为中心建立的三维坐标系;
根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态;
其中,通过设置于所述水下机器人上的磁力传感器,得到第一参照角度,所述第一参照角度为大地磁场中的正北方向的角度;根据所述第一参照角度,对所述第一水下实时姿态中的每个轴向角度进行矫正处理,得到矫正后的所述第二水下实时姿态。
2.根据权利要求1所述的数据处理方法,其特征在于,所述根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态之后包括:
建立大地坐标系;
根据所述大地坐标系和所述第二水下实时姿态所对应的机器坐标系,得到第一转换矩阵;
根据所述第一转换矩阵,得到第三实时姿态。
3.根据权利要求2所述的数据处理方法,其特征在于,所述根据所述第一转换矩阵,得到第三实时姿态包括:
根据所述第一转换矩阵,将所述机器坐标系中的每个轴向上的角度换算为所述大地坐标系中每个轴向上的角度。
4.一种基于水下机器人的数据处理装置,其特征在于,用于对水下机器人采集的水下感应数据进行数据处理,所述装置包括:
感应单元,用于通过感应装置,得到水下第一姿态角数据;
其中,所述感应单元包括:
加速度感应模块,用于通过设置于所述水下机器人上的加速度传感器,得到第一观测方程式计算因子;
陀螺仪感应模块,用于通过设置于所述水下机器人上的陀螺仪传感器,得到第一状态方程式计算因子
融合单元,用于对所述水下第一姿态角数据进行数据融合,得到第一水下实时姿态;
其中,根据所述第一观测方程式计算因子和所述第一状态方程式计算因子,建立得到第一卡尔曼滤波方程组,根据所述第一卡尔曼滤波方程组,得到所述第一水下实时姿态;所述第一水下实时姿态用于作为经过第一卡尔曼滤波方程组计算后的所述水下机器人在基于自身机器坐标系中的每个轴向上的角度,所述机器坐标系为所述水下机器人自身为中心建立的三维坐标系;
矫正单元,用于根据第一水下参照角数据对所述第一水下实时姿态进行数据矫正,得到矫正后的第二水下实时姿态;
其中,所述矫正单元包括:
参照数据获取模块,用于通过设置于所述水下机器人上的磁力传感器,得到第一参照角度,所述第一参照角度为大地磁场中的正北方向的角度;
矫正处理模块,用于根据所述第一参照角度,对所述第一水下实时姿态中的每个轴向角度进行矫正处理,得到矫正后的所述第二水下实时姿态。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810426447.3A CN108801260B (zh) | 2018-05-07 | 2018-05-07 | 基于水下机器人的数据处理方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810426447.3A CN108801260B (zh) | 2018-05-07 | 2018-05-07 | 基于水下机器人的数据处理方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108801260A CN108801260A (zh) | 2018-11-13 |
CN108801260B true CN108801260B (zh) | 2022-01-28 |
Family
ID=64091965
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810426447.3A Active CN108801260B (zh) | 2018-05-07 | 2018-05-07 | 基于水下机器人的数据处理方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108801260B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110231029B (zh) * | 2019-05-08 | 2021-07-13 | 西安交通大学 | 一种水下机器人多传感器融合数据处理方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102052924A (zh) * | 2010-11-25 | 2011-05-11 | 哈尔滨工程大学 | 一种小型水下机器人组合导航定位方法 |
CN102944233A (zh) * | 2012-11-08 | 2013-02-27 | 北京航空航天大学 | 核电站水下机器人的导航系统 |
CN104197927A (zh) * | 2014-08-20 | 2014-12-10 | 江苏科技大学 | 水下结构检测机器人实时导航系统及方法 |
CN107644441A (zh) * | 2017-08-30 | 2018-01-30 | 南京大学 | 基于三维成像的多足机器人复杂路况离散成落脚点方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101476894B (zh) * | 2009-02-01 | 2011-06-29 | 哈尔滨工业大学 | 车载sins/gps组合导航系统性能增强方法 |
CN102252676B (zh) * | 2011-05-06 | 2014-03-12 | 微迈森惯性技术开发(北京)有限公司 | 运动姿态数据获取、人体运动姿态追踪方法及相关设备 |
CN105318876A (zh) * | 2014-07-09 | 2016-02-10 | 北京自动化控制设备研究所 | 一种惯性里程计组合高精度姿态测量方法 |
CN104316080B (zh) * | 2014-10-13 | 2017-06-13 | 许志修 | 一种姿态陀螺仪倾斜补偿四元数解算装置 |
CN106647791B (zh) * | 2016-12-27 | 2020-08-14 | 广州市中海达测绘仪器有限公司 | 三维姿态测控装置、机械设备及三维姿态的测控方法 |
CN107883951A (zh) * | 2017-10-19 | 2018-04-06 | 福建海图智能科技有限公司 | 一种水下机器人三维姿态的计算方法及终端 |
-
2018
- 2018-05-07 CN CN201810426447.3A patent/CN108801260B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102052924A (zh) * | 2010-11-25 | 2011-05-11 | 哈尔滨工程大学 | 一种小型水下机器人组合导航定位方法 |
CN102944233A (zh) * | 2012-11-08 | 2013-02-27 | 北京航空航天大学 | 核电站水下机器人的导航系统 |
CN104197927A (zh) * | 2014-08-20 | 2014-12-10 | 江苏科技大学 | 水下结构检测机器人实时导航系统及方法 |
CN107644441A (zh) * | 2017-08-30 | 2018-01-30 | 南京大学 | 基于三维成像的多足机器人复杂路况离散成落脚点方法 |
Non-Patent Citations (2)
Title |
---|
基于MEMS传感器的高精度电子罗盘研究;葛海浪等;《机电工程》;20160320;第33卷(第03期);276-279 * |
用于水下ROV控制的姿态融合技术研究;裴国栋等;《航电技术应用研究》;20180430;第38卷(第4期);56-58 * |
Also Published As
Publication number | Publication date |
---|---|
CN108801260A (zh) | 2018-11-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108801250B (zh) | 基于水下机器人的实时姿态获取方法及装置 | |
CN109540126A (zh) | 一种基于光流法的惯性视觉组合导航方法 | |
CN106814753B (zh) | 一种目标位置矫正方法、装置及系统 | |
CN108225370B (zh) | 一种运动姿态传感器的数据融合与解算方法 | |
CN106767785B (zh) | 一种双回路无人机的导航方法及装置 | |
CN111091587B (zh) | 一种基于视觉标志物的低成本动作捕捉方法 | |
CN108225324B (zh) | 一种基于智能终端的地磁匹配与pdr融合的室内定位方法 | |
TWI556198B (zh) | 定位定向資料分析之系統及其方法 | |
CN111380514A (zh) | 机器人位姿估计方法、装置、终端及计算机存储介质 | |
CN110488865B (zh) | 无人机航向确定方法、装置及无人机 | |
CN110017837A (zh) | 一种姿态抗磁干扰的组合导航方法 | |
CN110377056B (zh) | 无人机航向角初值选取方法及无人机 | |
CN103512584A (zh) | 导航姿态信息输出方法、装置及捷联航姿参考系统 | |
CN107917707B (zh) | 一种任意姿态下行人方向的确定方法、装置及电子设备 | |
CN106370178B (zh) | 移动终端设备的姿态测量方法及装置 | |
CN108426576A (zh) | 基于标识点视觉导航与sins的飞行器路径规划方法及系统 | |
CN106352897B (zh) | 一种基于单目视觉传感器的硅mems陀螺误差估计与校正方法 | |
CN103712598A (zh) | 一种小型无人机姿态确定系统与确定方法 | |
CN108444468B (zh) | 一种融合下视视觉与惯导信息的定向罗盘 | |
CN110440797A (zh) | 车辆姿态估计方法及系统 | |
CN104913775A (zh) | 无人机对地高度的测量方法、无人机定位方法及装置 | |
CN110567493B (zh) | 一种磁力计校准数据采集方法、装置以及飞行器 | |
CN111060078A (zh) | 基于卫星观测角误差估计的定位方法 | |
CN104406592B (zh) | 一种用于水下滑翔器的导航系统及姿态角校正和回溯解耦方法 | |
CN108801260B (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 |