CN106989773A - 一种姿态传感器及姿态更新方法 - Google Patents
一种姿态传感器及姿态更新方法 Download PDFInfo
- Publication number
- CN106989773A CN106989773A CN201710223535.9A CN201710223535A CN106989773A CN 106989773 A CN106989773 A CN 106989773A CN 201710223535 A CN201710223535 A CN 201710223535A CN 106989773 A CN106989773 A CN 106989773A
- Authority
- CN
- China
- Prior art keywords
- distance measuring
- measuring sensor
- sensor
- measurement
- acceleration
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D21/00—Measuring or testing not otherwise provided for
- G01D21/02—Measuring two or more variables by means not covered by a single other subclass
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
- Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
Abstract
本发明公开了一种姿态传感器及姿态更新方法,它包括外壳、3个测距传感器、陀螺仪、加速度计、磁力计、WIFI模块、CPU、电源模块。陀螺仪和加速度计又称惯性传感器,与磁力计融合,常用于导航***的姿态更新。CPU由电源模块供电,CPU连接WIFI模块、惯性传感器、磁力计和3个测距传感器,将传感器测量的角速度、加速度、磁场强度、距离信息通过WIFI模块传送至计算机。通过姿态更新方法融合角速度、加速度、磁场强度和距离数据对姿态进行更新。本发明结构简单,成本低廉,适合对人体下肢姿态的长时间测量,其姿态更新方法易于扩展,且有效地解决了陀螺仪和加速度计的漂移问题。
Description
技术领域
本发明涉及一种融合测距传感器阵列与陀螺仪、加速度计、磁力计的姿态更新方法,特别是针对步态分析中下肢姿态的测量,如脚、小腿等近地肢体的姿态。
背景技术
目前广泛使用的基于MEMS工艺的姿态传感器主要是惯性传感器(IMU:陀螺仪、加速度计)和磁力计,以InvenSense公司生产的MPU6050、MPU6500和MPU9150、MPU9250等型号的姿态传感器最为常用,前两种只包含陀螺仪和加速度计,后两种包含了陀螺仪、加速度计和磁力计。针对这类传感器,常用的姿态获取算法是互补卡尔曼滤波、扩展卡尔曼滤波等算法,状态变量的选取多为欧拉角和四元素。仅仅使用IMU更新姿态,无法确定地理位置上的北方,需要互补滤波算法融合磁力计的数据以修正偏航角,或者使用扩展卡尔曼滤波算法把磁力计的数据融合到欧拉角或四元素,但是这类方法在磁力计受到***强磁场干扰时,反而会引入新的误差。
在一些实验和工况环境下,根据具体情形的需要,可以使用其它传感器和测量方法替代姿态传感器获取姿态、位移等信息。在人体步态测量中,更加精确的方法是使用红外高速摄像头捕捉人体肢体的姿态。使用红外反光材料制作的标记点贴于人体肢体的各个生理位置,高速摄像头则捕捉人体各个生理位置的空间位置,根据人体模型将人体各肢体姿态还原出来。但这套***十分昂贵,对环境的光线条件要求高,只能在室内使用,而且其使用的空间范围有限。
发明内容
本发明的目的是克服现有技术的不足,提供一种姿态传感器及姿态更新方法。
本发明的目的是通过以下技术方案来实现的:一种姿态传感器,包括外壳、第一测距传感器、惯性传感器、磁力计、第二测距传感器、电源模块、CPU、WIFI模块、第三测距传感器,所述惯性传感器由陀螺仪和加速度计组成;第一测距传感器、第二测距传感器、第三测距传感器水平安装于外壳外部,且第一测距传感器、第二测距传感器、第三测距传感器的安装位置处于同一水平面内;惯性传感器、磁力计、电源模块、CPU、WIFI模块均置于外壳内部;CPU由电源模块供电,CPU通过总线分别连接第一测距传感器、惯性传感器、磁力计、第二测距传感器、WIFI模块和第三测距传感器,第一测距传感器、第二测距传感器和第三测距传感器测量自身距离地面的距离信息,陀螺仪测量姿态传感器的角速度,加速度计测量姿态传感器的加速度,磁力计测量姿态传感器的周边环境的磁场强度,CPU将采集的距离信息、角速度、加速度、磁场强度打包后通过WIFI模块传送至外部计算机。
一种上述姿态传感器的姿态更新方法,包括以下步骤:
(1)将姿态传感器绑定在被测下肢上,使得3个测距传感器的测量探头朝向地面,能够测量它们与地面的距离信息,姿态传感器开始测量,得到角速度、加速度、磁场强度和3个测距传感器的距离信息;
(2)推导和建立融合角速度、加速度、磁场强度和距离信息的卡尔曼滤波算法;该步骤包括以下两个子步骤;
(2.1)状态向量X的预测更新;确定状态向量X=[q p v]T,其中,q为四元素,p为姿态传感器的位移,v为姿态传感器的速度,其状态方程用于状态向量X的预测更新:
Xk/k-1=F·Xk-1+uk-1
其中,Xk/k-1为k时刻预测更新后的状态变量,Xk-1为k-1时刻的状态变量,u为输入量,uk-1为k-1时刻的输入量,I表示单位矩阵,F为状态方程系数矩阵:
其中,yA=[yA,x yA,y yA,z]T为加速度计测量得到的加速度信息,以右下角小标号x、y、z分别表示向量在x轴、y轴、z轴上的分量,以右下角小标号A代表加速度计,yA,k-1为k-1时刻测量得到的加速度,为重力加速度的值,为姿态传感器的姿态矩阵,T为采样时间,Φ为四元素q的系数矩阵:
是陀螺仪测量得到的三维角速度;
(2.2)状态向量X的量测更新;用量测变量Z对预测更新后的状态变量Xk/k-1进行量测更新,即:
Xk=Xk/k-1+Kk·(Z-H·Xk/k-1)
其中,Xk为k时刻的量测更新后的状态变量,Kk为滤波增益,量测向量
Z=[yA yM d1 d2 d3 d21 d32 d13]T,量测方程系数矩阵H为:
其中,yA=[yA,x yA,y yA,z]T为加速度计测量得到的加速度信息,yM=[yM,x yM,yyM,z]T为磁力计测量得到的磁场强度信息,d1、d2、d3分别为第一测距传感器、第二测距传感器、第三测距传感器测量得到的距离信息,记测距传感器测量差值为dji=dj-di(i,j=1,2,3),d21、d32、d13分别为第二测距传感器与第一测距传感器、第三测距传感器与第二测距传感器、第一测距传感器与第三测距传感器的距离差值信息;
HA(k)为加速度yA的系数矩阵:
其中,为重力加速度的三维向量值,q=[q0 q1 q2 q3]T为四元素;
HM(k)为磁场强度yM的系数矩阵:
其中,为地磁场强度的三维向量值;
记分别为第一测距传感、第二测距传感器、第三测距传感器到惯性传感器的空间距离向量,记向量为上述空间距离向量的统一表达形式,记测距传感器测量的距离信息统一表达为di(i=1,2,3),分别为d1、d2、d3的系数矩阵,则距离信息di的系数矩阵统一表达形式为:
记P1、P2、P3分别为第一测距传感器、第二测距传感器、第三测距传感器的空间位置,以表示第一测距传感器到第二测距传感器的空间向量,以表示第二测距传感器到第三测距传感器的空间向量,以表示第三测距传感器到第一测距传感器的空间向量,记测距传感器测量差值信息为dji=dj-di(i,j=1,2,3),测距传感器相互位置的空间向量为分别为测距传感器测量差值信息d21、d32、d13的系数矩阵,它们的统一表达式为:
(3)根据卡尔曼滤波算法计算得到四元素;该步骤包括以下子步骤:
(3.1)使用陀螺仪测量得到的三维角速度信息和加速度计测量得到的加速度信息对状态变量X预测更新;
(3.2)使用加速度计测量得到的加速度信息、磁力计测量得到的磁场强度信息、第一测距传感器、第二测距传感器、第三测距传感器测量得到的距离信息、第二测距传感器与第一测距传感器、第三测距传感器与第二测距传感器、第一测距传感器与第三测距传感器的距离差值信息对状态变量X量测更新;
状态变量X包含四元素q,所以卡尔曼滤波后四元素的值已知;
(4)使用四元素计算得到姿态传感器的姿态矩阵和姿态角;
根据四元素q=[q0 q1 q2 q3]T计算姿态传感器的姿态矩阵为:
则根据该姿态矩阵可以计算姿态传感器的姿态角,姿态传感器的俯仰角θ、横滚角γ和方位角Ψ确定如下:
θ=arcsinT32
本发明的有益效果是,本发明在传统的融合IMU(陀螺仪和加速度计)和磁力计的姿态传感器上进行了改进,对原有结构部分充分保留,硬件上容易实现扩展。而且现在的基于MEMS工艺的测距传感器如激光测距传感器VL53L0X价格低廉,芯片体积小,方便安装于原有姿态传感器外壳周围,短距离内不会互相干扰,并且使用I2C通信,能够在同一CPU电路上同时挂载多个。这种新型的姿态传感器的姿态更新算法与常用的扩展卡尔曼更新算法十分相似,只是对其状态变量和量测变量做了补充,仍然不影响原算法的计算部分,可以简单地删减量测变量和量测方程系数矩阵的行来实现算法的转变。因为这种新型姿态传感器融合了3个测距传感器,而已知平面3个点的垂线到地面的长度,就可以准确地知道该平面的空间姿态,所以3个测距传感器数据对于姿态的矫正理论上是十分精确并且完全可以消除IMU的偏移误差的,算法的实现也并不复杂,相比传统的方法有很大的优势。
附图说明
图1为本发明姿态传感器的结构示意图;
图2为本发明各传感器的空间位置示意图;
图3为本发明姿态更新方法的简易流程图;
图中,外壳1、第一测距传感器2、惯性传感器3、陀螺仪4、加速度计5、磁力计6、第二测距传感器7、电源模块8、CPU9、WIFI模块10、第三测距传感器11。
具体实施方式
如图1所示,姿态传感器包括外壳1、第一测距传感器2、惯性传感器3、磁力计6、第二测距传感器7、电源模块8、CPU9、WIFI模块10、第三测距传感器11,所述惯性传感器3由陀螺仪4和加速度计5组成;第一测距传感器2、第二测距传感器7、第三测距传感器11水平安装于外壳1外部,且第一测距传感器2、第二测距传感器7、第三测距传感器11的安装位置处于同一水平面内;惯性传感器3、磁力计6、电源模块8、CPU9、WIFI模块10均置于外壳1内部;CPU9由电源模块8供电,CPU9通过总线分别连接第一测距传感器2、惯性传感器3、磁力计6、第二测距传感器7、WIFI模块10和第三测距传感器11,第一测距传感器2、第二测距传感器7和第三测距传感器11测量自身距离地面的距离信息,陀螺仪4测量姿态传感器的角速度,加速度计5测量姿态传感器的加速度,磁力计6测量姿态传感器的周边环境的磁场强度,CPU9将采集的距离信息、角速度、加速度、磁场强度打包后通过WIFI模块10传送至外部计算机。
如图2和图3所示,本发明所述的姿态传感器的姿态更新方法,包括以下步骤:
1、将姿态传感器绑定在被测下肢上,使得3个测距传感器的测量探头朝向地面,能够测量它们与地面的距离信息,姿态传感器开始测量,得到角速度、加速度、磁场强度和3个测距传感器的距离信息。
2、推导和建立融合角速度、加速度、磁场强度和距离信息的卡尔曼滤波算法,卡尔曼滤波算法包括预测更新和量测更新两个步骤。
第一步,状态向量X的预测更新。确定状态向量X=[q p v]T,其中,q为四元素,p为姿态传感器的位移,v为姿态传感器的速度,其状态方程用于状态向量X的预测更新:
Xk/k-1=F·Xk-1+uk-1
其中,Xk/k-1为k时刻预测更新后的状态变量,Xk-1为k-1时刻的状态变量,u为输入量,uk-1为k-1时刻的输入量,I表示单位矩阵,F为状态方程系数矩阵:
其中,yA=[yA,x yA,y yA,z]T为加速度计5测量得到的加速度信息,以右下角小标号x、y、z分别表示向量在x轴、y轴、z轴上的分量,以右下角小标号A代表加速度计,yA,k-1为k-1时刻测量得到的加速度,为重力加速度的值,为姿态传感器的姿态矩阵,T为采样时间,Φ为四元素q的系数矩阵:
是陀螺仪4测量得到的三维角速度。
第二步,状态向量X的量测更新。用量测变量Z对预测更新后的状态变量Xk/k-1进行量测更新,即
Xk=Xk/k-1+Kk·(Z-H·Xk/k-1)
其中,Xk为k时刻的量测更新后的状态变量,Kk为滤波增益,量测向量Z=[yA yM d1d2 d3 d21 d32 d13]T,量测方程系数矩阵H为:
其中,yA=[yA,x yA,y yA,z]T为加速度计5测量得到的加速度信息,yM=[yM,x yM,yyM,z]T为磁力计6测量得到的磁场强度信息,d1、d2、d3分别为第一测距传感器2、第二测距传感器7、第三测距传感器11测量得到的距离信息,记测距传感器测量差值为dji=dj-di(i,j=1,2,3),d21、d32、d13分别为第二测距传感器7与第一测距传感器2、第三测距传感器11与第二测距传感器7、第一测距传感器2与第三测距传感器11的距离差值信息。
HA(k)为加速度yA的系数矩阵:
其中,为重力加速度的三维向量值,q=[q0 q1 q2 q3]T为四元素。
HM(k)为磁场强度yM的系数矩阵:
其中,为地磁场强度的三维向量值。
记分别为第一测距传感器2、第二测距传感器7、第三测距传感器11到惯性传感器3的空间距离向量,记向量为上述空间距离向量的统一表达形式,记测距传感器测量的距离信息统一表达为di(i=1,2,3), 分别为d1、d2、d3的系数矩阵,则距离信息di的系数矩阵统一表达形式为:
记P1、P2、P3分别为第一测距传感器2、第二测距传感器7、第三测距传感器11的空间位置,以表示第一测距传感器2到第二测距传感器7的空间向量,以表示第二测距传感器7到第三测距传感器11的空间向量,以表示第三测距传感器11到第一测距传感器2的空间向量,记测距传感器测量差值信息为dji=dj-di(i,j=1,2,3),测距传感器相互位置的空间向量为分别为测距传感器测量差值信息d21、d32、d13的系数矩阵,它们的统一表达式为:
3、根据卡尔曼滤波算法计算得到四元素。即:
第一步,使用陀螺仪4测量得到的三维角速度信息和加速度计5测量得到的加速度信息对状态变量X预测更新。
第二步,使用加速度计5测量得到的加速度信息、磁力计6测量得到的磁场强度信息、第一测距传感器2、第二测距传感器7、第三测距传感器11测量得到的距离信息、第二测距传感器7与第一测距传感器2、第三测距传感器11与第二测距传感器7、第一测距传感器2与第三测距传感器11的距离差值信息对状态变量X量测更新。
状态变量X包含四元素q,所以卡尔曼滤波后四元素的值已知。
4、使用四元素计算得到姿态传感器的姿态矩阵和姿态角。
根据四元素q=[q0 q1 q2 q3]T计算姿态传感器的姿态矩阵为:
则根据该姿态矩阵可以计算姿态传感器的姿态角,姿态传感器的俯仰角θ、横滚角γ和方位角Ψ确定如下:
θ=arcsinT32
Claims (2)
1.一种姿态传感器,其特征在于,包括外壳(1)、第一测距传感器(2)、惯性传感器(3)、磁力计(6)、第二测距传感器(7)、电源模块(8)、CPU(9)、WIFI模块(10)、第三测距传感器(11)等,所述惯性传感器(3)由陀螺仪(4)和加速度计(5)等组成;第一测距传感器(2)、第二测距传感器(7)、第三测距传感器(11)水平安装于外壳(1)外部,且第一测距传感器(2)、第二测距传感器(7)、第三测距传感器(11)的安装位置处于同一水平面内;惯性传感器(3)、磁力计(6)、电源模块(8)、CPU(9)、WIFI模块(10)均置于外壳(1)内部;CPU(9)由电源模块(8)供电,CPU(9)通过总线分别连接第一测距传感器(2)、惯性传感器(3)、磁力计(6)、第二测距传感器(7)、WIFI模块(10)和第三测距传感器(11),第一测距传感器(2)、第二测距传感器(7)和第三测距传感器(11)测量自身距离地面的距离信息,陀螺仪(4)测量姿态传感器的角速度,加速度计(5)测量姿态传感器的加速度,磁力计(6)测量姿态传感器的周边环境的磁场强度,CPU(9)将采集的距离信息、角速度、加速度、磁场强度等信息打包后通过WIFI模块(10)传送至外部计算机。
2.一种权利要求1所述的姿态传感器的姿态更新方法,其特征在于,包括以下步骤:
(1)将姿态传感器绑定在被测下肢上,使得3个测距传感器的测量探头朝向地面,能够测量它们与地面的距离信息,姿态传感器开始测量,得到角速度、加速度、磁场强度和3个测距传感器的距离信息。
(2)推导和建立融合角速度、加速度、磁场强度和距离信息的卡尔曼滤波算法;该步骤包括以下两个子步骤。
(2.1)状态向量X的预测更新;确定状态向量X=[q p v]T,其中,q为四元素,p为姿态传感器的位移,v为姿态传感器的速度,其状态方程用于状态向量X的预测更新:
Xk/k-1=F·Xk-1+uk-1
其中,Xk/k-1为k时刻预测更新后的状态变量,Xk-1为k-1时刻的状态变量,u为输入量,uk-1为k-1时刻的输入量,I表示单位矩阵,F为状态方程系数矩阵:
其中,yA=[yA,x yA,y yA,z]T为加速度计(5)测量得到的加速度信息,以右下角小标号x、y、z分别表示向量在x轴、y轴、z轴上的分量,以右下角小标号A代表加速度计,yA,k-1为k-1时刻测量得到的加速度,为重力加速度的值,为姿态传感器的姿态矩阵,T为采样时间,Φ为四元素q的系数矩阵:
是陀螺仪(4)测量得到的三维角速度。
(2.2)状态向量X的量测更新;用量测变量Z对预测更新后的状态变量Xk/k-1进行量测更新,即:
Xk=Xk/k-1+Kk·(Z-H·Xk/k-1)
其中,Xk为k时刻的量测更新后的状态变量,Kk为滤波增益,量测向量
Z=[yA yM d1 d2 d3 d21 d32 d13]T,量测方程系数矩阵H为:
其中,yA=[yA,x yA,y yA,z]T为加速度计(5)测量得到的加速度信息,yM=[yM,x yM,y yM,z]T为磁力计(6)测量得到的磁场强度信息,d1、d2、d3分别为第一测距传感器(2)、第二测距传感器(7)、第三测距传感器(11)测量得到的距离信息,记测距传感器测量差值为dji=dj-di(i,j=1,2,3),d21、d32、d13分别为第二测距传感器(7)与第一测距传感器(2)、第三测距传感器(11)与第二测距传感器(7)、第一测距传感器(2)与第三测距传感器(11)的距离差值信息;
HA(k)为加速度yA的系数矩阵:
其中,为重力加速度的三维向量值,q=[q0q1q2q3]T为四元素;
HM(k)为磁场强度yM的系数矩阵:
其中,为地磁场强度的三维向量值;
记分别为第一测距传感器(2)、第二测距传感器(7)、第三测距传感器(11)到惯性传感器(3)的空间距离向量,记向量为上述空间距离向量的统一表达形式,记测距传感器测量的距离信息统一表达为di(i=1,2,3), 分别为d1、d2、d3的系数矩阵,则距离信息di的系数矩阵统一表达形式为:
记P1、P2、P3分别为第一测距传感器(2)、第二测距传感器(7)、第三测距传感器(11)的空间位置,以表示第一测距传感器(2)到第二测距传感器(7)的空间向量,以表示第二测距传感器(7)到第三测距传感器(11)的空间向量,以表示第三测距传感器(11)到第一测距传感器(2)的空间向量,记测距传感器测量差值信息为dji=dj-di(i,j=1,2,3),测距传感器相互位置的空间向量为 分别为测距传感器测量差值信息d21、d32、d13的系数矩阵,它们的统一表达式为:
(3)根据卡尔曼滤波算法计算得到四元素;该步骤包括以下子步骤:
(3.1)使用陀螺仪(4)测量得到的三维角速度信息和加速度计(5)测量得到的加速度信息对状态变量X预测更新。
(3.2)使用加速度计(5)测量得到的加速度信息、磁力计(6)测量得到的磁场强度信息、第一测距传感器(2)、第二测距传感器(7)、第三测距传感器(11)测量得到的距离信息、第二测距传感器(7)与第一测距传感器(2)、第三测距传感器(11)与第二测距传感器(7)、第一测距传感器(2)与第三测距传感器(11)的距离差值信息对状态变量X量测更新;状态变量X包含四元素q。
(4)使用四元素计算得到姿态传感器的姿态矩阵和姿态角;
根据四元素q=[q0 q1 q2 q3]T计算姿态传感器的姿态矩阵为:
则根据该姿态矩阵可以计算姿态传感器的姿态角,姿态传感器的俯仰角θ、横滚角γ和方位角Ψ确定如下:
θ=arcsinT32
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710223535.9A CN106989773B (zh) | 2017-04-07 | 2017-04-07 | 一种姿态传感器及姿态更新方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710223535.9A CN106989773B (zh) | 2017-04-07 | 2017-04-07 | 一种姿态传感器及姿态更新方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106989773A true CN106989773A (zh) | 2017-07-28 |
CN106989773B CN106989773B (zh) | 2019-07-16 |
Family
ID=59414824
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710223535.9A Active CN106989773B (zh) | 2017-04-07 | 2017-04-07 | 一种姿态传感器及姿态更新方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106989773B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108594798A (zh) * | 2018-01-09 | 2018-09-28 | 南京理工大学 | 一种可实现蜂拥控制的机器人小车***及其控制方法 |
CN109141414A (zh) * | 2018-09-05 | 2019-01-04 | 华南农业大学 | 一种田间作业车辆外部加速度辨识与姿态同步估计方法 |
CN109673529A (zh) * | 2018-12-24 | 2019-04-26 | 公安部南京警犬研究所 | 基于多传感器的警犬姿态识别数据背心及姿态识别方法 |
WO2019134305A1 (zh) * | 2018-01-03 | 2019-07-11 | 青岛海信电器股份有限公司 | 确定姿态的方法、装置、智能设备、存储介质和程序产品 |
CN113229804A (zh) * | 2021-05-07 | 2021-08-10 | 陕西福音假肢有限责任公司 | 一种用于关节活动度的磁场数据融合电路及其方法 |
CN114090140A (zh) * | 2020-08-05 | 2022-02-25 | 华为技术有限公司 | 基于指向操作的设备之间的交互方法及电子设备 |
US20220178692A1 (en) * | 2017-12-21 | 2022-06-09 | Mindmaze Holding Sa | System, method and apparatus of a motion sensing stack with a camera system |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101726295A (zh) * | 2008-10-24 | 2010-06-09 | 中国科学院自动化研究所 | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 |
CN102323854A (zh) * | 2011-03-11 | 2012-01-18 | 中国科学院研究生院 | 人体运动捕获装置 |
CN103808316A (zh) * | 2012-11-12 | 2014-05-21 | 哈尔滨恒誉名翔科技有限公司 | 室内飞行智能体惯性***与激光测距仪组合导航改进方法 |
CN104501814A (zh) * | 2014-12-12 | 2015-04-08 | 浙江大学 | 一种基于视觉和惯性信息的姿态与位置估计方法 |
CN105651283A (zh) * | 2016-03-14 | 2016-06-08 | 安徽斯玛特物联网科技有限公司 | 一种基于加速度、磁力计、陀螺仪、压力传感器的精确室内定位方法 |
CN205486161U (zh) * | 2016-01-08 | 2016-08-17 | 北京永利范思科技有限公司 | 一种虚拟现实头盔的头部运动捕捉装置 |
CN106197428A (zh) * | 2016-07-10 | 2016-12-07 | 北京工业大学 | 一种利用测量信息优化分布式ekf估计过程的slam方法 |
CN205899390U (zh) * | 2016-08-09 | 2017-01-18 | 青海北斗开阳航空科技有限公司 | 农林植保无人机自动飞行控制*** |
-
2017
- 2017-04-07 CN CN201710223535.9A patent/CN106989773B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101726295A (zh) * | 2008-10-24 | 2010-06-09 | 中国科学院自动化研究所 | 考虑加速度补偿和基于无迹卡尔曼滤波的惯性位姿跟踪方法 |
CN102323854A (zh) * | 2011-03-11 | 2012-01-18 | 中国科学院研究生院 | 人体运动捕获装置 |
CN103808316A (zh) * | 2012-11-12 | 2014-05-21 | 哈尔滨恒誉名翔科技有限公司 | 室内飞行智能体惯性***与激光测距仪组合导航改进方法 |
CN104501814A (zh) * | 2014-12-12 | 2015-04-08 | 浙江大学 | 一种基于视觉和惯性信息的姿态与位置估计方法 |
CN205486161U (zh) * | 2016-01-08 | 2016-08-17 | 北京永利范思科技有限公司 | 一种虚拟现实头盔的头部运动捕捉装置 |
CN105651283A (zh) * | 2016-03-14 | 2016-06-08 | 安徽斯玛特物联网科技有限公司 | 一种基于加速度、磁力计、陀螺仪、压力传感器的精确室内定位方法 |
CN106197428A (zh) * | 2016-07-10 | 2016-12-07 | 北京工业大学 | 一种利用测量信息优化分布式ekf估计过程的slam方法 |
CN205899390U (zh) * | 2016-08-09 | 2017-01-18 | 青海北斗开阳航空科技有限公司 | 农林植保无人机自动飞行控制*** |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20220178692A1 (en) * | 2017-12-21 | 2022-06-09 | Mindmaze Holding Sa | System, method and apparatus of a motion sensing stack with a camera system |
WO2019134305A1 (zh) * | 2018-01-03 | 2019-07-11 | 青岛海信电器股份有限公司 | 确定姿态的方法、装置、智能设备、存储介质和程序产品 |
CN108594798A (zh) * | 2018-01-09 | 2018-09-28 | 南京理工大学 | 一种可实现蜂拥控制的机器人小车***及其控制方法 |
CN108594798B (zh) * | 2018-01-09 | 2021-04-16 | 南京理工大学 | 一种可实现蜂拥控制的机器人小车***及其控制方法 |
CN109141414A (zh) * | 2018-09-05 | 2019-01-04 | 华南农业大学 | 一种田间作业车辆外部加速度辨识与姿态同步估计方法 |
CN109673529A (zh) * | 2018-12-24 | 2019-04-26 | 公安部南京警犬研究所 | 基于多传感器的警犬姿态识别数据背心及姿态识别方法 |
CN114090140A (zh) * | 2020-08-05 | 2022-02-25 | 华为技术有限公司 | 基于指向操作的设备之间的交互方法及电子设备 |
CN113229804A (zh) * | 2021-05-07 | 2021-08-10 | 陕西福音假肢有限责任公司 | 一种用于关节活动度的磁场数据融合电路及其方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106989773B (zh) | 2019-07-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106989773A (zh) | 一种姿态传感器及姿态更新方法 | |
CN103776451B (zh) | 一种基于mems的高精度三维姿态惯性测量***以及测量方法 | |
CN105300379B (zh) | 一种基于加速度的卡尔曼滤波姿态估计方法及*** | |
CN103090870B (zh) | 一种基于mems传感器的航天器姿态测量方法 | |
CN108225308A (zh) | 一种基于四元数的扩展卡尔曼滤波算法的姿态解算方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN108458714B (zh) | 一种姿态检测***中不含重力加速度的欧拉角求解方法 | |
CN107478223A (zh) | 一种基于四元数和卡尔曼滤波的人体姿态解算方法 | |
CN102980577A (zh) | 一种微型捷联航姿***及其工作方法 | |
CN106767804A (zh) | 一种运动物体的多维数据测量装置及方法 | |
CN202974288U (zh) | 一种微型捷联航姿*** | |
CN113008227B (zh) | 一种基于三轴加速度计测姿的地磁二分量测量方法 | |
CN106767805A (zh) | 基于mems传感器阵列的高精度惯性量测量方法及测量*** | |
CN103175502A (zh) | 一种基于数据手套低速运动的姿态角检测方法 | |
CN109916395A (zh) | 一种姿态自主冗余组合导航算法 | |
CN106052716A (zh) | 惯性系下基于星光信息辅助的陀螺误差在线标定方法 | |
CN111189474A (zh) | 基于mems的marg传感器的自主校准方法 | |
CN106441301A (zh) | 一种飞行器发射初始参数获取方法及*** | |
Dorveaux et al. | Combining inertial measurements and distributed magnetometry for motion estimation | |
CN107024206A (zh) | 一种基于ggi/gps/ins的组合导航*** | |
CN107764261A (zh) | 一种分布式pos传递对准用模拟数据生成方法和*** | |
Castellanos et al. | A low-cost air data attitude heading reference system for the tourism airplane applications | |
CN110207647A (zh) | 一种基于互补卡尔曼滤波器的臂环姿态角计算方法 | |
CN104978476B (zh) | 利用智能手机进行室内地图现场补测的方法 | |
CN103913169A (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 |