CN103185577A - 获取空间姿态数据的方法及*** - Google Patents
获取空间姿态数据的方法及*** Download PDFInfo
- Publication number
- CN103185577A CN103185577A CN 201110453713 CN201110453713A CN103185577A CN 103185577 A CN103185577 A CN 103185577A CN 201110453713 CN201110453713 CN 201110453713 CN 201110453713 A CN201110453713 A CN 201110453713A CN 103185577 A CN103185577 A CN 103185577A
- Authority
- CN
- China
- Prior art keywords
- component
- mobile device
- spatial 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
Links
Images
Landscapes
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
本发明涉及一种获取空间姿态数据的方法及***,所述方法包括:获取移动设备上传感器的ADC读数;将所述ADC读数去除误差并转化成物理量数据;以及将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据。本发明能够在移动设备的操作***内对传感器的ADC读数进行处理,以获取精确的移动设备的空间姿态信息提供给上层的应用程序使用,从而降低在移动设备上开发高级空间定位应用的门槛,缓解应用开发人员的负担,最大限度的发挥移动设备上传感器的硬件性能。
Description
技术领域
本发明涉及一种获取空间姿态数据的方法及***。
背景技术
随着移动设备配置成本降低,目前越来越多的移动设备上如手机、平板等同时装载了重力传感器、陀螺仪、电子罗盘以及GPS导航仪,这些传感器使得移动设备上的应用程序可以获得移动设备在X-Y-Z轴上的角速度、设备当前翻滚角(Roll)、俯仰角(Pitch)以及方位角(Yaw)等空间姿态数据成为可能,获取到的移动设备的空间姿态数据可以实现各类高级的LBS(Location Based Service基于位置的服务)和增强现实的应用,比如室内定位、全景摄像以及虚拟星空观测,从而提高移动设备的实用性和趣味性,另外,移动设备的应用程序还可以利用移动设备装载的陀螺仪、重力传感器、电子罗盘计算出移动设备的空间姿态数据如翻滚角(Roll)、俯仰角(Pitch)以及方位角(Yaw)实现虚拟现实游戏如平衡球、开飞机(如图1所示)等,或作为新式的交互设备如Wii Remote(Wii遥控器)。
由于移动设备采用的MEMS(Micro-Electro-Mechanical Systems,微机电***)传感器自身存在各种误差,如温漂、零点漂移,单个传感器的读数也很容易被外界环境所影响,造成与实际值很大的偏移,比如在移动设备运动时,无法从重力加速度传感器的读数获取当前重力场方向,又如在周围有磁场干扰时,无法从电子罗盘得到当前方位角信息。如果直接使用这类传感器原始数据,则无法实现比较高级和精确的定位应用,目前基于MEMS传感器的数据融合并进行姿态估计的技术已经比较成熟,并广泛应用于AHRS***(attitude headingreference system航姿)中,然而,由于相关的传感器近几年才在移动设备中同时普及,现有的移动操作***如iOS、Android等仍直接将传感器的原始数据提供给应用程序,并没有进行额外的数据融合操作,为了得到最终需要的姿态信息,应用程序开发人员需要自己编写数据融合算法进行计算,同时传感器数据中时常包含了干扰数据,这无疑增加了应用程序开发人员的负担,编写实现这类处理算法提高了相关应用程序开发门槛,增加了开发周期,另外,编写融合算法需要一定的专业知识,也无疑提高了在移动设备上进行精确姿态数据获取的门槛,阻碍了移动设备上传感器的广泛应用。
发明内容
本发明的目的在于提供一种获取空间姿态数据的方法及***,本发明能够获取精确的移动设备的空间姿态信息以提供给上层的应用程序使用,从而降低在移动设备上开发高级空间定位应用的门槛,缓解应用开发人员的负担,最大限度的发挥移动设备上传感器的硬件性能。
为解决上述问题,本发明提供一种获取空间姿态数据的方法,包括:
获取移动设备上传感器的ADC读数;
将所述ADC读数去除误差并转化成物理量数据;
根据所述物理量数据获取移动设备当前的空间姿态数据。
进一步的,在上述方法中,所述传感器为一个或多个。
进一步的,在上述方法中,根据所述物理数据获取移动设备当前的空间姿态数据步骤中,包括将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据。
进一步的,在上述方法中,所述多个传感器的物理量数据进行融合的处理在移动设备的操作***内进行。
进一步的,在上述方法中,所述多个传感器的物理量数据进行融合的处理在移动设备的操作***的中间层或操作***内核中进行。
进一步的,在上述方法中,所述多个传感器的物理量数据进行融合的处理的具体形式包括采用独立的***服务进程或采用运行在被服务的应用程序地址空间内的函数库。
进一步的,在上述方法中,采用Kalman Filter算法或Particle Filter算法将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据。
进一步的,在上述方法中,所述传感器包括重力传感器、陀螺仪、电子罗盘或GPS导航仪中的一种任意组合。
进一步的,在上述方法中,所述重力传感器的物理量数据包括移动设备在X轴所受的重力加速度以及外力加速度的Ax分量、移动设备在Y轴所受的重力加速度以及外力加速度的Ay分量,以及移动设备在Z轴所受的重力加速度以及外力加速度的Az分量。
进一步的,在上述方法中,所述陀螺仪的物理量数据包括移动设备在X轴上转动角速度的Gx分量、移动设备在Y轴上转动角速度的分量Gy,以及移动设备在Z轴上转动角速度的Gz分量。
进一步的,在上述方法中,所述电子罗盘的物理量数据包括移动设备在X轴上外界磁场强度的Hx分量、移动设备在Y轴上外界磁场强度的Hy分量,以及移动设备在Z轴上外界磁场强度的Hz分量。
进一步的,在上述方法中,所述空间姿态数据包括移动设备的俯仰角、翻滚角、方位角以及移动设备在X-Y-Z轴上的角速度。
进一步的,在上述方法中,所述俯仰角根据重力传感器的Ax、Az分量或根据陀螺仪的Gy分量获取。
进一步的,在上述方法中,所述俯仰角通过融合重力传感器的Ax、Az分量和陀螺仪的Gy分量后获取。
进一步的,在上述方法中,所述翻滚角根据重力传感器的Ay、Az分量或根据陀螺仪的Gx分量获取。
进一步的,在上述方法中,所述翻滚角通过融合重力传感器的Ay、Az分量和陀螺仪的Gx分量后获取。
进一步的,在上述方法中,所述方位角根据电子罗盘Hx、Hy、Hz分量、俯仰角及翻滚角或根据陀螺仪的Gz分量获取。
进一步的,在上述方法中,所述方位角通过融合电子罗盘Hx、Hy、Hz分量、俯仰角及翻滚角和陀螺仪的Gz分量后获取。
进一步的,在上述方法中,所述移动设备在X-Y-Z轴上的角速度根据陀螺仪的Gx、Gy、Gz分量或融合所述俯仰角、翻滚角、方位角获取。
根据本发明的另一面,提供一种获取空间姿态数据的***,包括:
ADC模块,用于获取移动设备上传感器的ADC读数;
物理量模块,用于将所述ADC读数去除误差并转化成物理量数据;
空间姿态模块,用于根据所述物理量数据获取移动设备当前的空间姿态数据。
进一步的,在上述***中,所述ADC模块用于获取移动设备上一个或多个传感器的ADC读数。
进一步的,在上述***中,所述空间姿态模块包括:
融合层单元,用于将多个传感器的物理量数据进行融合;
空间姿态单元,用于根据融合后的的物理量数据获取当前的空间姿态数据。
进一步的,在上述***中,所述空间姿态模块采用Kalman Filter算法或Particle Filter算法将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据。
进一步的,在上述***中,所述ADC模块用于获取移动设备上重力传感器、陀螺仪、电子罗盘或GPS导航仪中的ADC读数。
进一步的,在上述***中,所述物理量模块转化的重力传感器的物理量数据包括移动设备在X轴所受的重力加速度及外力加速度的Ax分量、移动设备在Y轴所受的重力加速度及外力加速度的Ay分量,以及移动设备在Z轴所受的重力加速度及外力加速度的Az分量。
进一步的,在上述***中,所述物理量模块转化的陀螺仪的物理量数据包括移动设备在X轴上转动角速度的Gx分量、移动设备在Y轴上转动角速度的分量Gy,以及移动设备在Z轴上转动角速度的Gz分量。
进一步的,在上述***中,所述物理量模块转化的电子罗盘的物理量数据包括移动设备在X轴上外界磁场强度的Hx分量、移动设备在Y轴上外界磁场强度的Hy分量,以及移动设备在Z轴上外界磁场强度的Hz分量。
进一步的,在上述***中,所述空间姿态模块获取的空间姿态数据包括移动设备的俯仰角、翻滚角、方位角以及移动设备在X-Y-Z轴上的角速度。
进一步的,在上述***中,所述空间姿态模块根据重力传感器的Ax、Az分量或陀螺仪的Gy分量获取所述俯仰角。
进一步的,在上述***中,所述空间姿态模块融合重力传感器的Ax、Az分量和陀螺仪的Gy分量后获取所述俯仰角。
进一步的,在上述***中,所述空间姿态模块根据重力传感器的Ay、Az分量或根据陀螺仪的Gx分量获取所述翻滚角。
进一步的,在上述***中,所述空间姿态模块融合重力传感器的Ay、Az分量和陀螺仪的Gx分量后获取所述翻滚角。
进一步的,在上述***中,所述空间姿态模块根据电子罗盘Hx、Hy、Hz分量、俯仰角及翻滚角或根据陀螺仪的Gz分量获取所述方位角。
进一步的,在上述***中,所述空间姿态模块融合电子罗盘Hx、Hy、Hz分量、俯仰角及翻滚角和陀螺仪的Gz分量后获取所述方位角。
进一步的,在上述***中,所述空间姿态模块根据陀螺仪的Gx、Gy、Gz分量或融合所述俯仰角、翻滚角、方位角获取移动设备在X-Y-Z轴上的角速度。
与现有技术相比,本发明通过获取移动设备上传感器的ADC读数,并将所述ADC读数去除误差并转化成物理量数据,以及将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据,在移动设备的操作***内对传感器的ADC读数进行处理,以获取精确的移动设备的空间姿态信息提供给上层的应用程序使用,从而降低在移动设备上开发高级空间定位应用的门槛,缓解应用开发人员的负担,最大限度的发挥移动设备上传感器的硬件性能。
附图说明
图1是现有的传感器获取的姿态信息用于虚拟现实游戏的示意图;
图2是本发明一实施例的获取空间姿态数据的方法的流程图;
图3为本发明一实施例的融合处理在移动设备的操作***内的结构图;
图4为本发明一实施例的数据融合层作为独立的***服务进程的形态图;
图5为本发明一实施例的数据融合层作为运行在应用程序内的函数库的形态图;
图6为本发明一实施例的采用Kalman Filter算法的物理量数据的融合过程图;
图7为本发明一实施例的获取空间姿态数据的***的模块图。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
图2是本发明一实施例的获取空间姿态数据的方法的流程图。
如图2所示,本发明提供一种获取空间姿态数据的方法,包括:
步骤S1,获取移动设备上传感器的ADC(模拟至数字转换器)读数;
步骤S2,将所述ADC读数去除误差并转化成物理量数据;
步骤S3,根据所述物理量数据获取移动设备当前的空间姿态数据。
可选的,步骤S1中的所述传感器为一个或多个,所述传感器包括重力传感器、陀螺仪、电子罗盘或GPS导航仪等中的一种或任意组合,所述传感器可为惯性传感器,从多个传感器获取移动设备的空间姿态数据比直接从单个传感器获得的读数具有更高的精度和稳定性。
当获取到移动设备上多个传感器的ADC读数时,相应的,步骤S2中将多个传感器的所述ADC读数去除误差并转化成物理量数据,所述误差如陀螺仪的零点漂移、重力传感器在设备运动时的误差,步骤S2中获得物理量数据可以供应用程序直接获取,以保证与现有操作***的兼容性,同时,也可以将多个传感器的物理量数据进行融合后获取移动设备当前的空间姿态数据,即将这些物理量数据流入移动设备操作***中间层的传感器数据融合层进行融合,得到融合后的空间姿态数据如X-Y-Z轴上的角速度、设备当前翻滚角(Roll)、俯仰角(Pitch)以及方位角(Yaw)。
图3为本发明一实施例的融合处理在移动设备的操作***内的结构图。
图4为本发明一实施例的数据融合层作为独立的***服务进程的形态图。
图5为本发明一实施例的数据融合层作为运行在应用程序内的函数库的形态图。
如图3所示,当获取到移动设备上多个传感器的ADC读数,传感器的ADC读数通过操作***内核的对应驱动程序如传感器驱动35、36、37获得,并完成基本数据处理40包括去除杂波及ADC读数量化,这些数据处理与现有的操作***中对重力传感器、陀螺仪、电子罗盘等的处理方式一致,即将传感器原始的ADC读数进行量化,换算成具体的物理量,例如重力传感器的g值分量,陀螺仪的角速度,电子罗盘的磁感分量以及地磁角度等,相应的,步骤S3中包括将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据,其中,所述多个传感器的物理量数据进行融合的处理(数据融合层)34在移动设备的操作***内进行,例如可以在移动设备的操作***的中间层38或操作***内核39中进行,图3中示出的是将所述多个传感器的物理量数据进行融合的处理(数据融合层)34放在移动设备的操作***的中间层38中进行,这里将多个传感器数据物理量数据融合获取空间姿态数据的方法整合进移动设备的操作***当中,由操作***将经过融合处理得到的精确的空间姿态数据提供给上层的应用程序31,32、33使用,从而降低在移动设备上开发高级空间定位应用的门槛,缓解应用开发人员的负担,最终最大限度的发挥移动设备上传感器的硬件性能。
如图4所示,所述多个传感器的物理量数据进行融合的处理(数据融合层)的具体形式可以采用独立的***服务进程41,供多个进程如进程A、进程B共享访问,如图5所示,所述多个传感器的物理量数据进行融合的处理(数据融合层)的具体形式也可以采用运行在被服务的应用程序如进程A、进程B的地址空间内的函数库51、52。
所述重力传感器的物理量数据包括移动设备在X轴所受的重力加速度以及外力加速度的Ax分量、移动设备在Y轴所受的重力加速度以及外力加速度的Ay分量,以及移动设备在Z轴所受的重力加速度以及外力加速度的Az分量。
所述陀螺仪的物理量数据包括移动设备在X轴上转动角速度的Gx分量、移动设备在Y轴上转动角速度的分量Gy,以及移动设备在Z轴上转动角速度的Gz分量。
所述电子罗盘的物理量数据包括移动设备在X轴上外界磁场强度的Hx分量、移动设备在Y轴上外界磁场强度的Hy分量,以及移动设备在Z轴上外界磁场强度的Hz分量。
各类传感器所测量的物理量数据如下表所示:
图6为本发明一实施例的采用Kalman Filter算法的物理量数据的融合过程图。
具体的,如图6所示,可以使用常见于AHRS***中的Kalman Filter(kalman滤波)算法对多个传感器的物理量数据进行融合的处理,以得到更加精确的空间姿态数据,进行融合的处理采用上表所示的物理量数据作为输入,经过融合得到各类空间姿态数据(空间位置信息),包括移动设备的俯仰角(Pitch)、翻滚角(Roll)、方位角(Yaw)以及移动设备在X-Y-Z轴上的角速度,从多个传感器获取这类空间姿态数据比直接从单个传感器获得的读数具有更高的精度和稳定性。
1)俯仰角(Pitch)
所述俯仰角分别根据重力传感器的Ax、Az分量或根据陀螺仪的Gy分量获取,通过重力传感器的Ax、Az分量可以获取在静止状态下的Pitch角度,但如果设备有运动时,通过重力传感器的读数将存在很大误差,也可以利用积分陀螺仪Gy角速度分量获得Pitch读数,该Gy角速度分量对移动设备产生的加速度干扰不敏感,但随着积分时间增加,其累积误差会趋向于无穷大,所以为了提高获取俯仰角的精确度,所述俯仰角也可通过融合重力传感器的Ax、Az分量和陀螺仪的Gy分量后获取,融合算法会将重力传感器和陀螺仪计算得到的Pitch用Kalman Filter算法进行融合,得到稳定且更加精确的Pitch角度。
2)翻滚角(Roll)
所述翻滚角分别根据重力传感器的Ay、Az分量或根据陀螺仪的Gx角速度积获取,但这两种计算方式均存在于Pitch一样的缺陷,所以为了提高获取的翻滚角的精确度,所述翻滚角也可通过Kalman Filter算法融合重力传感器的Ay、Az分量和陀螺仪的Gx分量后获取。
3)方位角(Yaw)
所述方位角为设备与地磁北极的夹角,方位角可分别根据电子罗盘的地磁分量Hx、Hy、Hz分量、Pitch和Roll或根据陀螺仪的Gz分量获取,即可根据电子罗盘(Hx,Hy,Hz)以及Pitch和Roll可以推算出水平面上X,Y轴上的地磁分量,从而计算出Yaw,也可以通过陀螺仪的Gz分量经积分得到Yaw,同理,为了避免单个传感器造成的误差,所述方位角通过Kalman Filter算法融合电子罗盘Hx、Hy、Hz分量和陀螺仪的Gz分量后获取,提高获取的方位角的精确度。
4)更精确地X-Y-Z轴角速度
所述移动设备在X-Y-Z轴上的角速度可根据陀螺仪的Gx、Gy、Gz分量获取,但是陀螺仪获得的X-Y-Z轴角速度会因为陀螺仪自身的温漂以及零点漂移现象随使用时间和产品差异出现误差,所以可以融合前面获取的所述俯仰角、翻滚角、方位角来进一步获取更加精确的X-Y-Z轴角速度。
经过融合处理后获取的空间姿态信息由操作***提供的API接口提供给需要的应用程序使用,另外,也可以采用Particle Filter(粒子滤波)算法进行物理量数据的融合处理。
图7为本发明一实施例的获取空间姿态数据的***的模块图。
如图7所示,本发明还提供另一种获取空间姿态数据的***,包括ADC模块1、物理量模块2及空间姿态模块3。
ADC模块1用于获取移动设备上传感器的ADC读数,具体的,所述ADC模块1可用于获取移动设备上一个或多个传感器的ADC读数,如获取移动设备上重力传感器、陀螺仪、电子罗盘或GPS导航仪中的ADC读数,从多个传感器获取这类空间姿态数据比直接从单个传感器获得的读数具有更高的精度和稳定性。
物理量模块2用于将所述ADC读数去除误差并转化成物理量数据,具体的,所述物理量模块2转化的重力传感器的物理量数据包括移动设备在X轴所受的重力加速度及外力加速度的Ax分量、移动设备在Y轴所受的重力加速度及外力加速度的Ay分量,以及移动设备在Z轴所受的重力加速度及外力加速度的Az分量;所述物理量模块2转化的陀螺仪的物理量数据包括移动设备在X轴上转动角速度的Gx分量、移动设备在Y轴上转动角速度的分量Gy,以及移动设备在Z轴上转动角速度的Gz分量;所述物理量模块2转化的电子罗盘的物理量数据包括移动设备在X轴上外界磁场强度的Hx分量、移动设备在Y轴上外界磁场强度的Hy分量,以及移动设备在Z轴上外界磁场强度的Hz分量。
空间姿态模块3用于根据所述物理量数据获取移动设备当前的空间姿态数据,所述空间姿态模块3包括融合层单元311和空间姿态单元312,所述融合层单元311用于将多个传感器的物理量数据进行融合,所述空间姿态单元312用于根据融合后的物理量数据获取当前的空间姿态数据,这里将多个传感器数据物理量数据融合获取空间姿态数据的方法整合进移动设备的操作***当中,由操作***将经过融合处理得到的精确的空间姿态数据提供给上层的应用程序使用,从而降低在移动设备上开发高级空间定位应用的门槛,缓解应用开发人员的负担,最终最大限度的发挥移动设备上传感器的硬件性能。
具体的,所述空间姿态模块3采用Kalman Filter算法或Particle Filter算法将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据。
所述空间姿态模块3获取的空间姿态数据包括移动设备的俯仰角、翻滚角、方位角以及移动设备在X-Y-Z轴上的角速度,所述空间姿态模块3根据重力传感器的Ax、Az分量或陀螺仪的Gy分量获取所述俯仰角,根据重力传感器的Ay、Az分量或根据陀螺仪的Gx分量获取所述翻滚角,根据电子罗盘Hx、Hy、Hz分量、俯仰角及翻滚角或根据陀螺仪的Gz分量获取所述方位角,根据陀螺仪的Gx、Gy、Gz分量获取移动设备在X-Y-Z轴上的角速度,另外,为了提高获取的空间姿态数据的精度,所述空间姿态模块3也可融合重力传感器的Ax、Az分量和陀螺仪的Gy分量后获取所述俯仰角,融合重力传感器的Ay、Az分量和陀螺仪的Gx分量后获取所述翻滚角,融合电子罗盘Hx、Hy、Hz分量、俯仰角及翻滚角和陀螺仪的Gz分量后获取所述方位角,融合所述俯仰角、翻滚角、方位角获取移动设备在X-Y-Z轴上的角速度
本发明通过获取移动设备上传感器的ADC读数,并将所述ADC读数去除误差并转化成物理量数据,以及将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据,能够在移动操作***内对传感器的ADC读数进行处理,以获取精确的移动设备的空间姿态信息以提供给上层的应用程序使用,从而降低在移动设备上开发高级空间定位应用的门槛,缓解应用开发人员的负担,最大限度的发挥移动设备上传感器的硬件性能。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的***而言,由于与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
专业人员还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
显然,本领域的技术人员可以对发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包括这些改动和变型在内。
Claims (35)
1.一种获取空间姿态数据的方法,其特征在于,包括:
获取移动设备上传感器的ADC读数;
将所述ADC读数去除误差并转化成物理量数据;
根据所述物理量数据获取移动设备当前的空间姿态数据。
2.如权利要求1所述的获取空间姿态数据的方法,其特征在于,所述传感器为一个或多个。
3.如权利要求2所述的获取空间姿态数据的方法,其特征在于,根据所述物理数据获取移动设备当前的空间姿态数据步骤中,包括将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据。
4.如权利要求3所述的获取空间姿态数据的方法,其特征在于,所述多个传感器的物理量数据进行融合的处理在移动设备的操作***内进行。
5.如权利要求4所述的获取空间姿态数据的方法,其特征在于,所述多个传感器的物理量数据进行融合的处理在移动设备的操作***的中间层或操作***内核中进行。
6.如权利要求5所述的获取空间姿态数据的方法,其特征在于,所述多个传感器的物理量数据进行融合的处理的具体形式包括采用独立的***服务进程或采用运行在被服务的应用程序地址空间内的函数库。
7.如权利要求3所述的获取空间姿态数据的方法,其特征在于,采用KalmanFilter算法或Particle Filter算法将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据。
8.如权利要求7所述的获取空间姿态数据的方法,其特征在于,所述传感器包括重力传感器、陀螺仪、电子罗盘或GPS导航仪中的一种或任意组合。
9.如权利要求8所述的获取空间姿态数据的方法,其特征在于,所述重力传感器的物理量数据包括移动设备在X轴所受的重力加速度以及外力加速度的Ax分量、移动设备在Y轴所受的重力加速度以及外力加速度的Ay分量,以及移动设备在Z轴所受的重力加速度以及外力加速度的Az分量。
10.如权利要求9所述的获取空间姿态数据的方法,其特征在于,所述陀螺仪的物理量数据包括移动设备在X轴上转动角速度的Gx分量、移动设备在Y轴上转动角速度的分量Gy,以及移动设备在Z轴上转动角速度的Gz分量。
11.如权利要求10所述的获取空间姿态数据的方法,其特征在于,所述电子罗盘的物理量数据包括移动设备在X轴上外界磁场强度的Hx分量、移动设备在Y轴上外界磁场强度的Hy分量,以及移动设备在Z轴上外界磁场强度的Hz分量。
12.如权利要求11所述的获取空间姿态数据的方法,其特征在于,所述空间姿态数据包括移动设备的俯仰角、翻滚角、方位角以及移动设备在X-Y-Z轴上的角速度。
13.如权利要求12所述的获取空间姿态数据的方法,其特征在于,所述俯仰角根据重力传感器的Ax、Az分量或根据陀螺仪的Gy分量获取。
14.如权利要求12所述的获取空间姿态数据的方法,其特征在于,所述俯仰角通过融合重力传感器的Ax、Az分量和陀螺仪的Gy分量后获取。
15.如权利要求12所述的获取空间姿态数据的方法,其特征在于,所述翻滚角根据重力传感器的Ay、Az分量或根据陀螺仪的Gx分量获取。
16.如权利要求12所述的获取空间姿态数据的方法,其特征在于,所述翻滚角通过融合重力传感器的Ay、Az分量和陀螺仪的Gx分量后获取。
17.如权利要求12所述的获取空间姿态数据的方法,其特征在于,所述方位角根据电子罗盘Hx、Hy、Hz分量、俯仰角及翻滚角或根据陀螺仪的Gz分量获取。
18.如权利要求12所述的获取空间姿态数据的方法,其特征在于,所述方位角通过融合电子罗盘Hx、Hy、Hz分量、俯仰角及翻滚角和陀螺仪的Gz分量后获取。
19.如权利要求13至18任一项所述的获取空间姿态数据的方法,其特征在于,所述移动设备在X-Y-Z轴上的角速度根据陀螺仪的Gx、Gy、Gz分量或融合所述俯仰角、翻滚角、方位角获取。
20.一种获取空间姿态数据的***,其特征在于,包括:
ADC模块,用于获取移动设备上传感器的ADC读数;
物理量模块,用于将所述ADC读数去除误差并转化成物理量数据;
空间姿态模块,用于根据所述物理量数据获取移动设备当前的空间姿态数据。
21.如权利要求20所述的获取空间姿态数据的***,其特征在于,所述ADC模块用于获取移动设备上一个或多个传感器的ADC读数。
22.如权利要求21所述的获取空间姿态数据的***,其特征在于,所述空间姿态模块包括:
融合层单元,用于将多个传感器的物理量数据进行融合;
空间姿态单元,用于根据融合后的的物理量数据获取当前的空间姿态数据。
23.如权利要求22所述的获取空间姿态数据的***,其特征在于,所述空间姿态模块采用Kalman Filter算法或Particle Filter算法将多个传感器的物理量数据进行融合获取移动设备当前的空间姿态数据。
24.如权利要求23所述的获取空间姿态数据的***,其特征在于,所述ADC模块用于获取移动设备上重力传感器、陀螺仪、电子罗盘或GPS导航仪中的ADC读数。
25.如权利要求24所述的获取空间姿态数据的***,其特征在于,所述物理量模块转化的重力传感器的物理量数据包括移动设备在X轴所受的重力加速度及外力加速度的Ax分量、移动设备在Y轴所受的重力加速度及外力加速度的Ay分量,以及移动设备在Z轴所受的重力加速度及外力加速度的Az分量。
26.如权利要求25所述的获取空间姿态数据的***,其特征在于,所述物理量模块转化的陀螺仪的物理量数据包括移动设备在X轴上转动角速度的Gx分量、移动设备在Y轴上转动角速度的分量Gy,以及移动设备在Z轴上转动角速度的Gz分量。
27.如权利要求26所述的获取空间姿态数据的***,其特征在于,所述物理量模块转化的电子罗盘的物理量数据包括移动设备在X轴上外界磁场强度的Hx分量、移动设备在Y轴上外界磁场强度的Hy分量,以及移动设备在Z轴上外界磁场强度的Hz分量。
28.如权利要求27所述的获取空间姿态数据的***,其特征在于,所述空间姿态模块获取的空间姿态数据包括移动设备的俯仰角、翻滚角、方位角以及移动设备在X-Y-Z轴上的角速度。
29.如权利要求28所述的获取空间姿态数据的***,其特征在于,所述空间姿态模块根据重力传感器的Ax、Az分量或陀螺仪的Gy分量获取所述俯仰角。
30.如权利要求28所述的获取空间姿态数据的***,其特征在于,所述空间姿态模块融合重力传感器的Ax、Az分量和陀螺仪的Gy分量后获取所述俯仰角。
31.如权利要求28所述的获取空间姿态数据的***,其特征在于,所述空间姿态模块根据重力传感器的Ay、Az分量或根据陀螺仪的Gx分量获取所述翻滚角。
32.如权利要求28所述的获取空间姿态数据的***,其特征在于,所述空间姿态模块融合重力传感器的Ay、Az分量和陀螺仪的Gx分量后获取所述翻滚角。
33.如权利要求28所述的获取空间姿态数据的***,其特征在于,所述空间姿态模块根据电子罗盘Hx、Hy、Hz分量、俯仰角及翻滚角或根据陀螺仪的Gz分量获取所述方位角。
34.如权利要求28所述的获取空间姿态数据的***,其特征在于,所述空间姿态模块融合电子罗盘Hx、Hy、Hz分量、俯仰角及翻滚角和陀螺仪的Gz分量后获取所述方位角。
35.如权利要求28至35任一项所述的获取空间姿态数据的***,其特征在于,所述空间姿态模块根据陀螺仪的Gx、Gy、Gz分量或融合所述俯仰角、翻滚角、方位角获取移动设备在X-Y-Z轴上的角速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110453713 CN103185577A (zh) | 2011-12-29 | 2011-12-29 | 获取空间姿态数据的方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110453713 CN103185577A (zh) | 2011-12-29 | 2011-12-29 | 获取空间姿态数据的方法及*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103185577A true CN103185577A (zh) | 2013-07-03 |
Family
ID=48676875
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201110453713 Pending CN103185577A (zh) | 2011-12-29 | 2011-12-29 | 获取空间姿态数据的方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103185577A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105955467A (zh) * | 2016-04-26 | 2016-09-21 | 四川川大智胜软件股份有限公司 | 基于移动终端的多人人机交互方法 |
CN107193380A (zh) * | 2017-05-26 | 2017-09-22 | 成都斯斐德科技有限公司 | 一种低成本高精度虚拟现实定位及交互*** |
CN109104518A (zh) * | 2017-06-20 | 2018-12-28 | 卡西欧计算机株式会社 | 信息处理装置、信息处理方法、记录介质以及信息处理*** |
CN110667725A (zh) * | 2019-11-11 | 2020-01-10 | 路邦科技授权有限公司 | 一种全地形移动机器人的平衡***及其控制方法 |
-
2011
- 2011-12-29 CN CN 201110453713 patent/CN103185577A/zh active Pending
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105955467A (zh) * | 2016-04-26 | 2016-09-21 | 四川川大智胜软件股份有限公司 | 基于移动终端的多人人机交互方法 |
CN107193380A (zh) * | 2017-05-26 | 2017-09-22 | 成都斯斐德科技有限公司 | 一种低成本高精度虚拟现实定位及交互*** |
CN107193380B (zh) * | 2017-05-26 | 2020-04-03 | 成都斯斐德科技有限公司 | 一种高精度虚拟现实定位*** |
CN109104518A (zh) * | 2017-06-20 | 2018-12-28 | 卡西欧计算机株式会社 | 信息处理装置、信息处理方法、记录介质以及信息处理*** |
CN109104518B (zh) * | 2017-06-20 | 2021-07-06 | 卡西欧计算机株式会社 | 信息处理装置、信息处理方法、记录介质及信息处理*** |
CN110667725A (zh) * | 2019-11-11 | 2020-01-10 | 路邦科技授权有限公司 | 一种全地形移动机器人的平衡***及其控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109931926B (zh) | 一种基于站心坐标系的小型无人机无缝自主式导航方法 | |
US9541392B2 (en) | Surveying system and method | |
US10197587B2 (en) | Device and method for using time rate of change of sensor data to determine device rotation | |
Shen et al. | Optical Flow Sensor/INS/Magnetometer Integrated Navigation System for MAV in GPS‐Denied Environment | |
CN109163721A (zh) | 姿态测量方法及终端设备 | |
CN105737854B (zh) | 一种捷联惯导***在线标定方法 | |
CN105571591A (zh) | 一种多信息深组合导航微***及导航方法 | |
CN103512584A (zh) | 导航姿态信息输出方法、装置及捷联航姿参考*** | |
EP2502026A2 (en) | Spatial alignment determination for an inertial measurement unit (imu) | |
CN105371844A (zh) | 一种基于惯性/天文互助的惯性导航***初始化方法 | |
CN109186597A (zh) | 一种基于双mems-imu的室内轮式机器人的定位方法 | |
CN109696178A (zh) | 偏移校正装置、偏移校正程序、步行者航位推算装置及记录介质 | |
CN109141411B (zh) | 定位方法、定位装置、移动机器人及存储介质 | |
CN112595350A (zh) | 一种惯导***自动标定方法及终端 | |
CN103185577A (zh) | 获取空间姿态数据的方法及*** | |
CN107045136A (zh) | 可配置的惯性/天文/北斗多组合导航***及其导航方法 | |
CN104897153A (zh) | 一种基于mems和mr传感器的载体姿态测量*** | |
TWI591365B (zh) | 旋翼飛行器的定位方法 | |
JP5017527B2 (ja) | 電子コンパスシステム | |
CN105303201A (zh) | 一种基于动作感应进行手写识别的方法和*** | |
CN110514201B (zh) | 一种惯性导航***及适用于高转速旋转体的导航方法 | |
CN111141283A (zh) | 一种通过地磁数据判断行进方向的方法 | |
CN116660579A (zh) | 一种风速计数据校正方法、***及装置 | |
CN109827572A (zh) | 一种检测车位置预测的方法及装置 | |
CN110285811A (zh) | 卫星定位和惯性导航的融合定位方法和装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C05 | Deemed withdrawal (patent law before 1993) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20130703 |