CN104764452A - 一种基于惯性和光学跟踪***的混合位姿跟踪方法 - Google Patents
一种基于惯性和光学跟踪***的混合位姿跟踪方法 Download PDFInfo
- Publication number
- CN104764452A CN104764452A CN201510198694.9A CN201510198694A CN104764452A CN 104764452 A CN104764452 A CN 104764452A CN 201510198694 A CN201510198694 A CN 201510198694A CN 104764452 A CN104764452 A CN 104764452A
- Authority
- CN
- China
- Prior art keywords
- target
- mark
- acceleration
- tracking system
- optical tracking
- 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
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/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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- 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
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开了一种基于惯性和光学跟踪***的混合位姿跟踪方法,通过将惯性跟踪***和光学跟踪***进行结合使用,可以解决在标志物被部分遮挡时对目标的准确位置和姿态跟踪;利用光学跟踪结果修正惯性传感器数据,消除了偏置误差,提高了惯性跟踪模块在进行姿态估计时的精度;在利用卡尔曼滤波器与惯性跟踪***进行姿态跟踪时,通过建立加速度误差模型,在测量噪声协方差矩阵中引入突变速运动测量噪声协方差,当***发生线性运动时,状态方程的测量更新方程中,对测量值的置信程度也会降低,使得状态矢量中估计值占有更大的置信度,减小了加速度计测量值因突变线性加速度的影响而导致的对状态矢量的影响。
Description
技术领域
本发明涉及智能传感与人机交互领域,尤其涉及一种基于惯性和光学跟踪***的混合位姿跟踪方法。
背景技术
由于惯性跟踪***根据陀螺仪的角速度、加速度计的加速度以及磁传感器的磁强度计算目标的姿态角,具有刷新频率较高以及测量延迟较低的优点且跟踪时不依赖于外部标志点。将光学与惯性跟踪***进行融合能够获得实时性更好、精度更高的跟踪结果,在出现遮挡问题时可以在较短时间继续进行位置和姿态跟踪。
国内外研究者对惯性-光学混合跟踪方法进行了广泛研究。Young等人于2006年提出了混合式跟踪***,其中包含了一个由6台摄像机构成的Vicon光学跟踪***和一个固定在目标上的装配了反光标志点的惯性跟踪模块(InertialMeasurement Unit,IMU),在保持光学跟踪***的高精度的同时将刷新频率提高到100Hz(参见Young M C,Young S S,Sang K.Pose estimation fromlandmark-based vision and inertial sensors.In:Proceedings of the 2006InternationalJoint Conference on SICE-ICASE.Bexco,Busan,Korea:IEEE,2006,1668-1671.)。N.Parnian于2008年提出了用于跟踪笔状目标的混合跟踪***,安装了IMU的目标的尖部可以被四个依弧线排列的摄像机所识别,混合跟踪***提高了光学跟踪***的刷新频率和位置跟踪精度(参见Maidi M,Ababsa F,Mallem M.Vision-inertial tracking system for robust fiducials registration in augmented reality.In:Proceedings of the 2009IEEE Symposium on Computational Intelligence forMultimedia Signal and Vision Processing.Nashville,TN,USA:IEEE,2009.83-90)。Maidi于2009年提出了一个由两个摄像机和三个标志物组成的光学跟踪***(刷新率为55Hz)以及一个跟标志物绑定的惯性跟踪模块(刷新率为500Hz)组成的混合跟踪***,实验结果表明该***可以实现在短时间光学遮挡条件下的姿态跟踪(参见Waechter C,Huber M,Keitler P,Schlegel M,Pustka D,Klinker G.Amulti-sensor platform for wide-area tracking.In:Proceedings of the 9th IEEEInternational Symposium on Mixed and Augmented Reality.Seoul,Korea:IEEE,2010.275-276.)。上述各方法通过融合惯性和光学跟踪方法有效提高了跟踪***的刷新率并实现了在出现遮挡时进行短时间继续跟踪,但是在跟踪目标位置时会产生随时间累计的漂移误差且其自身会产生偏置误差、线性加速度误差等,上述方法并不能够实现在长时间遮挡情况下的准确跟踪。
发明内容
有鉴于此,本发明提供了一种基于惯性和光学跟踪***的混合位姿跟踪方法,可以解决在标志点被部分遮挡时对目标的准确位置和姿态跟踪,同时利用光学跟踪结果修正惯性传感器数据,消除了偏置误差。
为了解决上述技术问题,本发明是这样实现的:
本发明的一种基于惯性和光学跟踪***的混合位姿跟踪方法,包括:
1)、在光学跟踪***中的标志物上的标志点未被遮挡时,利用光学跟踪***捕获当前时刻目标的位置和姿态信息,作为位姿跟踪的结果;
2)、在所述标志物上的部分标志点被遮挡,光学跟踪***只能获得标志点的位置信息但无法获得目标的姿态信息时,执行如下步骤:
S21、当前时刻,采用光学跟踪***得到所述标志点的三维空间坐标Xn、Yn和Zn;
S22、采用加速度计、磁传感器和陀螺仪组成的惯性跟踪***获得所述标志物当前时刻的角速度、加速度和磁场的测量值,进而采用卡尔曼滤波器得到表征标志物姿态信息的俯仰角、横滚角和航向角,以及当前时刻标志物的姿态旋转矩阵Rn;
S23、确定标志物上原点与所述标志点的三维空间位移:ΔXn、ΔYn和ΔZn;
S24、基于如下公式得到当前时刻所述原点的三维空间坐标X0、Y0和Z0:
S25、根据目标与所述原点既定的位置关系,得到目标的位置信息;
如此,将S22获得的当前时刻的姿态信息和S25获得的当前时刻目标的位置信息,作为对目标位姿跟踪的结果。
较佳的,在1)中,光学跟踪***进行位姿跟踪的同时,采用陀螺仪、加速度计和磁传感器分别对目标的角速度、加速度和磁场进行测量;然后根据光学跟踪***获得的姿态信息,使用余弦算法计算出目标当前位姿对应的理想的角速度、加速度和磁场,并分别与陀螺仪、加速度计以及磁传感器的测量值进行比对,获得陀螺仪、加速度计以及磁传感器的偏置误差;
在S22中,在采用惯性跟踪***获得标志物的角速度、加速度和磁场的测量值后,采用1)中的偏置误差分别对该三个测量值进行补偿,再根据补偿后的角速度、加速度和磁场,得到S22中当前时刻目标的姿态信息以及标志物的姿态旋转矩阵Rn。
较佳的,所述S22中,采用卡尔曼滤波器获得当前时刻目标的姿态信息的方法为:
S221、在时间更新方程中对目标的状态矢量进行估计:
其中,A为所述陀螺仪测得的目标在三个敏感轴上角速度测量值构成的滤波器增益矩阵;为当前时刻目标状态矢量估计值,为卡尔曼滤波器上一时刻输出的目标状态矢量;
S222、对卡尔曼滤波器的传递函数的估计值进行更新:
其中,Q值为***噪声协方差矩阵;AT为增益矩阵A的转置矩阵;Pk-1为卡尔曼滤波器上一时刻输出的传递函数;
S223、通过卡尔曼滤波器对目标姿态信息进行测量更新,具体为:
基于步骤S221中更新得到的传递函数的估计值获得卡尔曼滤波器的测量置信参数Kk:
其中,H为测量模型与估计模型间转换矩阵:
[q1 q2 q3 q4]T表示组成目标的状态矢量估计值的旋转四元数,即Rk=Ra+Rb为测量噪声协方差矩阵,由匀速运动噪声协方差Ra和突变速运动测量噪声协方差Rb组成,Rb=ACCx 2+ACCy 2+ACCz 2-g2,其中ACCx、ACCy和ACCz分别为加速度传感器测得的目标在三个敏感轴上的加速度分量,g为重力加速度;
S224、对目标的状态矢量的测量结果进行更新:
S225、对传递函数的测量结果Pk进行更新:
S225、从所述目标状态矢量的测量结果中提取当前时刻的目标姿态信息;将当前时刻测量结果和传递函数的测量结果Pk输出并作为下一时刻滤波器的输入结果,返回S221,进行下一时刻的目标姿态跟踪。
较佳的,所述步骤1)中,当有两个标志点未被遮挡时,采用S21-S24的方法分别基于各标志点的位置信息得到所述原点的位置信息并求均值,在S25中,利用该原点位置信息的均值,得到目标的位置。
本发明具有如下有益效果:
(1)本发明提出的混合位姿跟踪方法,通过将惯性跟踪***和光学跟踪***进行结合使用,可以解决在标志物被部分遮挡时对目标的准确位置和姿态跟踪;
(2)本发明利用光学跟踪结果修正惯性传感器数据,消除了偏置误差,提高了惯性跟踪模块在进行姿态估计时的精度;
(3)本发明在利用卡尔曼滤波器与惯性跟踪***进行姿态跟踪时,通过建立加速度误差模型,在测量噪声协方差矩阵中引入突变速运动测量噪声协方差,当***发生线性运动时,状态方程的测量更新方程中,对测量值的置信程度也会降低,使得状态矢量中估计值占有更大的置信度,减小了加速度计测量值因突变线性加速度的影响而导致的对状态矢量的影响。
附图说明
图1是本发明的偏置误差校正算法。
具体实施方式
下面结合附图并举实施例,对本发明进行详细描述。
本发明以手术中对手术工具进行长时间位姿跟踪为例进行说明。手术过程中,需要对手术工具相对于病灶部分的位置和姿态进行实时的精确计算,以便引导手术的顺利进行。光学跟踪***通过手术工具上设置的标志物对手术工具进行定位以及姿态跟踪。但在手术过程中,经常出现标志物被遮挡的情况,当标志物上只有两个或一个标志点未被遮挡,则会导致光学跟踪***只能利用标志物获得位置信息,却无法获得姿态信息,因此,本发明提出一种基于惯性和光学跟踪***的混合位姿跟踪方法,可以解决在标志点被部分遮挡时对标志物的准确位置和姿态跟踪,具体方法如下:
1)、正常情况下,作为位姿跟踪的标志物上的标志点未被遮挡,此时采用光学跟踪***得到当前时刻标志物的位置和姿态信息,作为位姿跟踪的结果。
2)、当出现标志物上的标志点被遮挡,即光学跟踪***只能观察一个或两个标志点时,光学跟踪***只能获得标志物的位置信息,由于三个标志点才能确定标志物的姿态,因此,一个或两个标志点的信息不足以获得标志物的姿态信息,则执行如下步骤:
S21、当前时刻,采用光学跟踪***得到未被遮挡的标志点的三维空间坐标Xn、Yn和Zn;
S22、采用加速度计、磁传感器和陀螺仪组成的惯性跟踪***获得所述标志物当前时刻的角速度、加速度和磁场的测量值,采用卡尔曼滤波器获得当前时刻标志物的俯仰角θ、横滚角γ和航向角ψ,最终得到当前时刻标志物的姿态旋转矩阵:
S23、确定标志物上原点与所述标志点的三维空间位移:ΔXn、ΔYn和ΔZn;
S24、上述步骤已经确定了标志物的旋转矩阵以及原点与所述标志点的三维空间位移,则旋转矩阵与三维位移的乘积即为原点在全局坐标系中的空间位移,再用标志点坐标减去该全局坐标系中的空间位移,则得到原点在全局坐标系中的坐标X0、Y0和Z0:
S25、根据可见标志点与所述标志物原点既定的位置关系,得到标志物的位置信息;
需要说明的是,当有两个标志点未被遮挡时,采用上述S21-S24的方法分别基于各标志点的位置信息得到所述原点的位置信息并求均值,本步骤中,利用该原点位置信息的均值,得到标志物的位置;
标志物如此,将S25获得的当前时刻标志物的位置信息和S22获得的当前时刻的姿态信息,作为位姿跟踪的结果。
在1)中,光学跟踪***进行位姿跟踪的同时,采用陀螺仪、加速度计和磁传感器分别对标志物的角速度、加速度和磁场进行测量;然后根据光学跟踪***获得的姿态信息,使用余弦算法计算出标志物当前位姿对应的角速度、加速度和磁场,由于光学跟踪***的精确度更高,因此由光学跟踪***的姿态信息解算的角速度、加速度和磁场值较惯性***的测量值具有更高的精确度,因此,可用,将光学跟踪***的姿态信息解算的角速度、加速度和磁场值分别与陀螺仪、加速度计以及磁传感器的测量值进行比对,获得陀螺仪、加速度计以及磁传感器的偏置误差;
在S22中,在采用惯性跟踪***获得标志物的的角速度、加速度和磁场的测量值后,采用1)中的偏置误差分别对该三个测量值进行补偿,再根据补偿后的角速度、加速度和磁场,分别得到S22中标志物的姿态信息和旋转矩阵Rn标志物,如此,在光学跟踪***的姿态跟踪失效不得已采用惯性跟踪***时,可提高惯性跟踪***的跟踪精度。
考虑到加速度计测量重力加速度值时,可能会因突变的线性加速度的出现而受到影响,本发明还对卡尔曼滤波过程进行了改进,具体为步骤S22中采用卡尔曼滤波器获得当前时刻标志物的姿态信息的方法:
S221、在时间更新方程中对标志物姿态状态矢量进行估计:
其中,A为所述陀螺仪测得的标志物在三个敏感轴上角速度测量值构成的滤波器增益矩阵;为当前时刻标志物姿态状态矢量估计值,为卡尔曼滤波器上一时刻输出的标志物状态矢量;
S222、对卡尔曼滤波器的传递函数的估计值进行更新:
其中,Q值为***噪声协方差矩阵;AT为增益矩阵A的转置矩阵;Pk-1为卡尔曼滤波器上一时刻输出的传递函数;
S223、在卡尔曼滤波器中对标志物姿态信息进行测量更新,具体为:
基于步骤S221中更新得到的传递函数的估计值获得卡尔曼滤波器的测量置信参数Kk:
其中,通过如下公式获得测量模型与估计模型间的转换矩阵H:
[q1 q2 q3 q4]T表示组成目标的状态矢量估计值的旋转四元数,即Rk为测量噪声协方差矩阵。为了消除突变线性加速度对加速度计测量重力加速度值时产生的影响,本发明定义了加速度误差模型并在定义测量噪声协方差时,将Rk分为匀速运动噪声协方差Ra和突变速运动测量噪声协方差Rb:
Rk=Ra+Rb
加速度计被用来测量地球重力场在三轴上的分量从而推导出标志物的当前姿态。在理想情况下,三轴上的加速度分量平方和应为重力加速度g的平方。然而,重力加速度计的测量值还和传感器的线性加速度大小有关,这部分与重力加速度无关的线性加速度被视为姿态测量中的误差,线性加速度误差模型通过如下方程进行定义:
Rb=ACCx 2+ACCy 2+ACCz 2-g2
其中ACCx、ACCy和ACCz分别为加速度传感器测得的加速度在标志物三个敏感轴上的分量;
S224、对标志物姿态状态矢量的测量结果进行更新:
表示标志物的姿态,其中,θ=arcsin(ACCx)表示标志物的俯仰角,表示标志物的横滚角,表示标志物的航向角,A=MAGxcos(θ)+MAGysin(θ)+MAGzcos(θ)sin(γ),B=MAGycos(γ)+MAGzsin(γ),MAGx、MAGy和MAGz分别表示磁场传感器获得的标志物所在位置的地球磁场在体坐标系的三个敏感轴上的分量;利用加速度计和磁传感器进行姿态解算是通过离散测量和余弦算法实现的,其结果不会受到漂移误差的影响。
当***发生线性运动时,加速度值的平方和将大于或小于g的平方,他们之间的差值构成了本方法定义的加速度误差模型。当此误差增加,Rb和Rk会随之增加进而导致Kk减小。于是在测量更新方程(1)中对测量值的置信程度也会降低,使得状态矢量中估计值占有更大的置信度,减小了加速度计测量值因突变线性加速度的影响而导致的对状态矢量的影响。
S225、对传递函数Pk进行更新:
S225、标志物状态矢量的测量结果即为当前时刻的标志物姿态跟踪结果;将当前时刻测量结果和传递函数的测量结果Pk输出并作为下一时刻滤波器的输入结果,返回S261,进行下一时刻的标志物姿态跟踪。
当全部标志点都可见时,光学跟踪方法能够同时获取标志板的6自由度位置和姿态信息。当任一标志点被遮挡时,纯光学跟踪***只能得到可见标志点的空间位置但是不能计算标志物的标志板的三维姿态及旋转矩阵R。本发明在部分标志点被遮挡时通过惯性跟踪***继续跟踪标志物的三维姿态以及旋转矩阵R,进而得到完整的位置和姿态跟踪结果解决了光学遮挡问题。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (4)
1.一种基于惯性和光学跟踪***的混合位姿跟踪方法,其特征在于,包括:
1)、在光学跟踪***中的标志物上的标志点未被遮挡时,利用光学跟踪***捕获当前时刻目标的位置和姿态信息,作为位姿跟踪的结果;
2)、在所述标志物上的部分标志点被遮挡,光学跟踪***只能获得标志点的位置信息但无法获得目标的姿态信息时,执行如下步骤:
S21、当前时刻,采用光学跟踪***得到所述标志点的三维空间坐标Xn、Yn和Zn;
S22、采用加速度计、磁传感器和陀螺仪组成的惯性跟踪***获得所述标志物当前时刻的角速度、加速度和磁场的测量值,进而采用卡尔曼滤波器得到表征标志物姿态信息的俯仰角、横滚角和航向角,以及当前时刻标志物的姿态旋转矩阵Rn;
S23、确定标志物上原点与所述标志点的三维空间位移:ΔXn、ΔYn和ΔZn;
S24、基于如下公式得到当前时刻所述原点的三维空间坐标X0、Y0和Z0:
S25、根据目标与所述原点既定的位置关系,得到目标的位置信息;
如此,将S22获得的当前时刻的姿态信息和S25获得的当前时刻目标的位置信息,作为对目标位姿跟踪的结果。
2.如权利要求1所述的一种基于惯性和光学跟踪***的混合位姿跟踪方法,其特征在于:
在1)中,光学跟踪***进行位姿跟踪的同时,采用陀螺仪、加速度计和磁传感器分别对目标的角速度、加速度和磁场进行测量;然后根据光学跟踪***获得的姿态信息,使用余弦算法计算出目标当前位姿对应的理想的角速度、加速度和磁场,并分别与陀螺仪、加速度计以及磁传感器的测量值进行比对,获得陀螺仪、加速度计以及磁传感器的偏置误差;
在S22中,在采用惯性跟踪***获得标志物的角速度、加速度和磁场的测量值后,采用1)中的偏置误差分别对该三个测量值进行补偿,再根据补偿后的角速度、加速度和磁场,得到S22中当前时刻目标的姿态信息以及标志物的姿态旋转矩阵Rn。
3.如权利要求1或2所述的一种基于惯性和光学跟踪***的混合位姿跟踪方法,其特征在于,所述S22中,采用卡尔曼滤波器获得当前时刻目标的姿态信息的方法为:
S221、在时间更新方程中对目标的状态矢量进行估计:
其中,A为所述陀螺仪测得的目标在三个敏感轴上角速度测量值构成的滤波器增益矩阵;为当前时刻目标状态矢量估计值,为卡尔曼滤波器上一时刻输出的目标状态矢量;
S222、对卡尔曼滤波器的传递函数的估计值进行更新:
其中,Q值为***噪声协方差矩阵;AT为增益矩阵A的转置矩阵;Pk-1为卡尔曼滤波器上一时刻输出的传递函数;
S223、通过卡尔曼滤波器对目标姿态信息进行测量更新,具体为:
基于步骤S221中更新得到的传递函数的估计值Pk -,获得卡尔曼滤波器的测量置信参数Kk:
其中,H为测量模型与估计模型间转换矩阵:
[q1 q2 q3 q4]T表示组成目标的状态矢量估计值的旋转四元数,即Rk=Ra+Rb为测量噪声协方差矩阵,由匀速运动噪声协方差Ra和突变速运动测量噪声协方差Rb组成,其中ACCx、ACCy和ACCz分别为加速度传感器测得的目标在三个敏感轴上的加速度分量,g为重力加速度;
S224、对目标的状态矢量的测量结果进行更新
S225、对传递函数的测量结果Pk进行更新:
S225、从所述目标状态矢量的测量结果中提取当前时刻的目标姿态信息;将当前时刻测量结果和传递函数的测量结果Pk输出并作为下一时刻滤波器的输入结果,返回S221,进行下一时刻的目标姿态跟踪。
4.如权利要求1或2所述的一种基于惯性和光学跟踪***的混合位姿跟踪方法,其特征在于,所述步骤1)中,当有两个标志点未被遮挡时,采用S21-S24的方法分别基于各标志点的位置信息得到所述原点的位置信息并求均值,在S25中,利用该原点位置信息的均值,得到目标的位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510198694.9A CN104764452A (zh) | 2015-04-23 | 2015-04-23 | 一种基于惯性和光学跟踪***的混合位姿跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510198694.9A CN104764452A (zh) | 2015-04-23 | 2015-04-23 | 一种基于惯性和光学跟踪***的混合位姿跟踪方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104764452A true CN104764452A (zh) | 2015-07-08 |
Family
ID=53646430
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510198694.9A Pending CN104764452A (zh) | 2015-04-23 | 2015-04-23 | 一种基于惯性和光学跟踪***的混合位姿跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104764452A (zh) |
Cited By (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016150312A1 (zh) * | 2015-03-20 | 2016-09-29 | 阿里巴巴集团控股有限公司 | 一种地磁传感器校准方法、装置及智能设备 |
CN106123901A (zh) * | 2016-07-20 | 2016-11-16 | 上海乐相科技有限公司 | 一种定位方法及装置 |
CN106813679A (zh) * | 2015-12-01 | 2017-06-09 | 佳能株式会社 | 运动物体的姿态估计的方法及装置 |
CN108259780A (zh) * | 2018-04-17 | 2018-07-06 | 北京艾沃次世代文化传媒有限公司 | 用于虚拟片场抗干扰特效视频同步显示方法 |
CN108369268A (zh) * | 2015-12-14 | 2018-08-03 | 皇家飞利浦有限公司 | 用于医学设备跟踪的***和方法 |
CN109001787A (zh) * | 2018-05-25 | 2018-12-14 | 北京大学深圳研究生院 | 一种姿态角解算与定位的方法及其融合传感器 |
CN109298629A (zh) * | 2017-07-24 | 2019-02-01 | 来福机器人 | 用于为自主和非自主位置意识提供鲁棒跟踪的容错 |
CN109313500A (zh) * | 2016-06-09 | 2019-02-05 | 微软技术许可有限责任公司 | 纤细形状因子的无源光学和惯性跟踪 |
CN109521802A (zh) * | 2017-09-19 | 2019-03-26 | 博世(上海)智能科技有限公司 | 用于运动轨迹跟踪的方法、装置和设备 |
CN109561393A (zh) * | 2018-12-24 | 2019-04-02 | 北京全电智领科技有限公司 | 一种基于空间光通信技术的低速载具定位方法及装置 |
CN109674534A (zh) * | 2017-10-18 | 2019-04-26 | 深圳市掌网科技股份有限公司 | 一种基于增强现实的手术导航图像显示方法和*** |
CN110147164A (zh) * | 2019-05-22 | 2019-08-20 | 京东方科技集团股份有限公司 | 头部运动跟踪方法、设备、***及存储介质 |
CN110168478A (zh) * | 2017-01-09 | 2019-08-23 | 斯纳普公司 | 表面识别镜头 |
CN110230983A (zh) * | 2019-07-16 | 2019-09-13 | 北京欧比邻科技有限公司 | 抗振式光学三维定位方法及装置 |
CN110672087A (zh) * | 2019-09-02 | 2020-01-10 | 深圳市众采堂艺术空间设计有限公司 | 一种人体跟踪方法及*** |
CN111949123A (zh) * | 2020-07-01 | 2020-11-17 | 青岛小鸟看看科技有限公司 | 多传感器手柄控制器混合追踪方法及装置 |
CN112066984A (zh) * | 2020-09-17 | 2020-12-11 | 深圳维特智能科技有限公司 | 姿态角度解算方法、装置、处理设备和存储介质 |
CN112484722A (zh) * | 2020-11-19 | 2021-03-12 | 易思维(杭州)科技有限公司 | 结合惯性导航***的视觉传感器全局定位方法 |
CN114111772A (zh) * | 2021-11-29 | 2022-03-01 | 江苏科技大学 | 一种基于数据手套的水下机器人软体作业手位置跟踪方法 |
TWI766282B (zh) * | 2019-12-31 | 2022-06-01 | 中國商上海商湯智能科技有限公司 | 標定方法、電子設備及儲存介質 |
US11443491B2 (en) | 2019-06-28 | 2022-09-13 | Snap Inc. | 3D object camera customization system |
US11501499B2 (en) | 2018-12-20 | 2022-11-15 | Snap Inc. | Virtual surface modification |
US11580700B2 (en) | 2016-10-24 | 2023-02-14 | Snap Inc. | Augmented reality object manipulation |
US11620791B2 (en) | 2018-11-27 | 2023-04-04 | Snap Inc. | Rendering 3D captions within real-world environments |
US11715268B2 (en) | 2018-08-30 | 2023-08-01 | Snap Inc. | Video clip object tracking |
WO2023165355A1 (zh) * | 2022-03-03 | 2023-09-07 | 瑞龙诺赋(上海)医疗科技有限公司 | 手术平台定位***、位姿信息确定方法以及装置 |
US11908093B2 (en) | 2019-12-19 | 2024-02-20 | Snap Inc. | 3D captions with semantic graphical elements |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1996007947A1 (en) * | 1994-08-31 | 1996-03-14 | Virtual I/O, Inc. | Personal display system |
US5644078A (en) * | 1995-10-02 | 1997-07-01 | Ahdoot; Ned | Optical gyroscope |
CN101275843A (zh) * | 2007-03-29 | 2008-10-01 | 北京控制工程研究所 | 中高轨道航天器的可见光成像式自主导航敏感器*** |
CN101598556A (zh) * | 2009-07-15 | 2009-12-09 | 北京航空航天大学 | 一种未知环境下无人机视觉/惯性组合导航方法 |
WO2011020096A1 (en) * | 2009-08-14 | 2011-02-17 | IPOZ Systems, LLC | Device, program product and computer implemented method for touchless metrology using an inertial navigation system and laser |
CN102612704A (zh) * | 2009-10-19 | 2012-07-25 | Metaio有限公司 | 用于提供针对图像的至少一个特征的描述符的方法和用于匹配特征的方法 |
CN102829779A (zh) * | 2012-09-14 | 2012-12-19 | 北京航空航天大学 | 一种飞行器多个光流传感器与惯导组合导航方法 |
-
2015
- 2015-04-23 CN CN201510198694.9A patent/CN104764452A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1996007947A1 (en) * | 1994-08-31 | 1996-03-14 | Virtual I/O, Inc. | Personal display system |
US5644078A (en) * | 1995-10-02 | 1997-07-01 | Ahdoot; Ned | Optical gyroscope |
CN101275843A (zh) * | 2007-03-29 | 2008-10-01 | 北京控制工程研究所 | 中高轨道航天器的可见光成像式自主导航敏感器*** |
CN101598556A (zh) * | 2009-07-15 | 2009-12-09 | 北京航空航天大学 | 一种未知环境下无人机视觉/惯性组合导航方法 |
WO2011020096A1 (en) * | 2009-08-14 | 2011-02-17 | IPOZ Systems, LLC | Device, program product and computer implemented method for touchless metrology using an inertial navigation system and laser |
CN102612704A (zh) * | 2009-10-19 | 2012-07-25 | Metaio有限公司 | 用于提供针对图像的至少一个特征的描述符的方法和用于匹配特征的方法 |
CN102829779A (zh) * | 2012-09-14 | 2012-12-19 | 北京航空航天大学 | 一种飞行器多个光流传感器与惯导组合导航方法 |
Non-Patent Citations (1)
Title |
---|
CHANGYU HE等: "Fusion of inertial sensing to compensate for partial occlusions in optical tracking systems", 《SPRINGER INTERNATIONAL PUBLISHING》 * |
Cited By (37)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016150312A1 (zh) * | 2015-03-20 | 2016-09-29 | 阿里巴巴集团控股有限公司 | 一种地磁传感器校准方法、装置及智能设备 |
CN106813679A (zh) * | 2015-12-01 | 2017-06-09 | 佳能株式会社 | 运动物体的姿态估计的方法及装置 |
CN108369268A (zh) * | 2015-12-14 | 2018-08-03 | 皇家飞利浦有限公司 | 用于医学设备跟踪的***和方法 |
CN109313500A (zh) * | 2016-06-09 | 2019-02-05 | 微软技术许可有限责任公司 | 纤细形状因子的无源光学和惯性跟踪 |
CN106123901A (zh) * | 2016-07-20 | 2016-11-16 | 上海乐相科技有限公司 | 一种定位方法及装置 |
CN106123901B (zh) * | 2016-07-20 | 2019-08-06 | 上海乐相科技有限公司 | 一种定位方法及装置 |
US11580700B2 (en) | 2016-10-24 | 2023-02-14 | Snap Inc. | Augmented reality object manipulation |
CN110168478A (zh) * | 2017-01-09 | 2019-08-23 | 斯纳普公司 | 表面识别镜头 |
US11704878B2 (en) | 2017-01-09 | 2023-07-18 | Snap Inc. | Surface aware lens |
CN109298629A (zh) * | 2017-07-24 | 2019-02-01 | 来福机器人 | 用于为自主和非自主位置意识提供鲁棒跟踪的容错 |
CN109298629B (zh) * | 2017-07-24 | 2023-08-15 | 南京市远弗科技有限公司 | 在未绘制地图区域中引导移动平台的***及方法 |
CN109521802A (zh) * | 2017-09-19 | 2019-03-26 | 博世(上海)智能科技有限公司 | 用于运动轨迹跟踪的方法、装置和设备 |
CN109674534A (zh) * | 2017-10-18 | 2019-04-26 | 深圳市掌网科技股份有限公司 | 一种基于增强现实的手术导航图像显示方法和*** |
CN108259780A (zh) * | 2018-04-17 | 2018-07-06 | 北京艾沃次世代文化传媒有限公司 | 用于虚拟片场抗干扰特效视频同步显示方法 |
CN109001787A (zh) * | 2018-05-25 | 2018-12-14 | 北京大学深圳研究生院 | 一种姿态角解算与定位的方法及其融合传感器 |
CN109001787B (zh) * | 2018-05-25 | 2022-10-21 | 北京大学深圳研究生院 | 一种姿态角解算与定位的方法及其融合传感器 |
US11715268B2 (en) | 2018-08-30 | 2023-08-01 | Snap Inc. | Video clip object tracking |
US12020377B2 (en) | 2018-11-27 | 2024-06-25 | Snap Inc. | Textured mesh building |
US11620791B2 (en) | 2018-11-27 | 2023-04-04 | Snap Inc. | Rendering 3D captions within real-world environments |
US11501499B2 (en) | 2018-12-20 | 2022-11-15 | Snap Inc. | Virtual surface modification |
CN109561393A (zh) * | 2018-12-24 | 2019-04-02 | 北京全电智领科技有限公司 | 一种基于空间光通信技术的低速载具定位方法及装置 |
CN110147164A (zh) * | 2019-05-22 | 2019-08-20 | 京东方科技集团股份有限公司 | 头部运动跟踪方法、设备、***及存储介质 |
US11443491B2 (en) | 2019-06-28 | 2022-09-13 | Snap Inc. | 3D object camera customization system |
US11823341B2 (en) | 2019-06-28 | 2023-11-21 | Snap Inc. | 3D object camera customization system |
CN110230983A (zh) * | 2019-07-16 | 2019-09-13 | 北京欧比邻科技有限公司 | 抗振式光学三维定位方法及装置 |
CN110672087B (zh) * | 2019-09-02 | 2023-08-11 | 湖南凌傲科技有限公司 | 一种人体跟踪方法及*** |
CN110672087A (zh) * | 2019-09-02 | 2020-01-10 | 深圳市众采堂艺术空间设计有限公司 | 一种人体跟踪方法及*** |
US11908093B2 (en) | 2019-12-19 | 2024-02-20 | Snap Inc. | 3D captions with semantic graphical elements |
TWI766282B (zh) * | 2019-12-31 | 2022-06-01 | 中國商上海商湯智能科技有限公司 | 標定方法、電子設備及儲存介質 |
CN111949123A (zh) * | 2020-07-01 | 2020-11-17 | 青岛小鸟看看科技有限公司 | 多传感器手柄控制器混合追踪方法及装置 |
CN111949123B (zh) * | 2020-07-01 | 2023-08-08 | 青岛小鸟看看科技有限公司 | 多传感器手柄控制器混合追踪方法及装置 |
US12008173B2 (en) | 2020-07-01 | 2024-06-11 | Qingdao Pico Technology Co., Ltd. | Multi-sensor handle controller hybrid tracking method and device |
CN112066984A (zh) * | 2020-09-17 | 2020-12-11 | 深圳维特智能科技有限公司 | 姿态角度解算方法、装置、处理设备和存储介质 |
CN112484722A (zh) * | 2020-11-19 | 2021-03-12 | 易思维(杭州)科技有限公司 | 结合惯性导航***的视觉传感器全局定位方法 |
CN114111772B (zh) * | 2021-11-29 | 2023-10-03 | 江苏科技大学 | 一种基于数据手套的水下机器人软体作业手位置跟踪方法 |
CN114111772A (zh) * | 2021-11-29 | 2022-03-01 | 江苏科技大学 | 一种基于数据手套的水下机器人软体作业手位置跟踪方法 |
WO2023165355A1 (zh) * | 2022-03-03 | 2023-09-07 | 瑞龙诺赋(上海)医疗科技有限公司 | 手术平台定位***、位姿信息确定方法以及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104764452A (zh) | 一种基于惯性和光学跟踪***的混合位姿跟踪方法 | |
US10216265B1 (en) | System and method for hybrid optical/inertial headtracking via numerically stable Kalman filter | |
Ahmed et al. | Accurate attitude estimation of a moving land vehicle using low-cost MEMS IMU sensors | |
CN107655476B (zh) | 基于多信息融合补偿的行人高精度足部导航方法 | |
US10885640B2 (en) | Enhanced object detection and motion estimation for a vehicle environment detection system | |
CN106093994B (zh) | 一种基于自适应加权混合卡尔曼滤波的多源联合定位方法 | |
Lee et al. | Robust mobile robot localization using optical flow sensors and encoders | |
CN103630137B (zh) | 一种用于导航***的姿态及航向角的校正方法 | |
US8320616B2 (en) | Image-based system and methods for vehicle guidance and navigation | |
CN105043385A (zh) | 一种行人自主导航定位的自适应卡尔曼滤波方法 | |
JP2012207919A (ja) | 異常値判定装置、測位装置、及びプログラム | |
CN108761512A (zh) | 一种弹载bds/sins深组合自适应ckf滤波方法 | |
CN107490378A (zh) | 一种基于mpu6050与智能手机的室内定位与导航的方法 | |
Bistrov | Performance analysis of alignment process of MEMS IMU | |
KR20160120467A (ko) | 차량용 2차원 레이더의 방위각 보정 장치 및 방법 | |
Zheng et al. | Train integrated positioning method based on GPS/INS/RFID | |
Niu et al. | Camera-based lane-aided multi-information integration for land vehicle navigation | |
Zhang et al. | Indoor localization using inertial sensors and ultrasonic rangefinder | |
US8812235B2 (en) | Estimation of N-dimensional parameters while sensing fewer than N dimensions | |
CN116482735A (zh) | 一种受限空间内外高精度定位方法 | |
US10274317B2 (en) | Method and apparatus for determination of misalignment between device and vessel using radius of rotation | |
Kubo et al. | Nonlinear filtering methods for the INS/GPS in-motion alignment and navigation | |
CN109387220B (zh) | 一种步行微惯性导航设备方位安装偏差校正方法 | |
Baer et al. | EgoMaster: A central ego motion estimation for driver assist systems | |
Zhai et al. | Application of unscented Kalman filter in GPS/INS |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20150708 |
|
WD01 | Invention patent application deemed withdrawn after publication |