Apparatus for determining the position of a selected object relative to a moving reference frame, the apparatus including at least one reference frame transceiver assembly firmly attached to the moving reference frame, at least one object transceiver assembly firmly attached to the selected object,
Apparatus for determining the position of a selected object relative to a moving reference frame, the apparatus including at least one reference frame transceiver assembly firmly attached to the moving reference frame, at least one object transceiver assembly firmly attached to the selected object, an inertial measurement unit firmly attached to the selected object, an inertial navigation system firmly attached to the moving reference frame, and a tracking processor coupled with the object transceiver assembly, with the inertial measurement unit and with the inertial navigation system, the object transceiver assembly communicating with the reference frame transceiver assembly using magnetic fields, the inertial measurement unit producing IMU inertial measurements of motion of the selected object with respect to an inertially fixed reference frame, the inertial navigation system producing INS inertial measurements of motion of the moving reference frame with respect to the inertially fixed reference frame, the tracking processor receiving electromagnetic measurements resulting from the magnetic communication between the reference frame transceiver assembly and the object transceiver assembly, the tracking processor determining the position of the selected object relative to the moving reference frame by using the IMU inertial measurements and the INS inertial measurements to optimize the electromagnetic measurements.
대표청구항▼
The invention claimed is: 1. Apparatus for determining the position of a selected object relative to a moving reference frame, the apparatus comprising: at least one reference frame transceiver assembly, firmly attached to said moving reference frame; at least one object transceiver assembly, firml
The invention claimed is: 1. Apparatus for determining the position of a selected object relative to a moving reference frame, the apparatus comprising: at least one reference frame transceiver assembly, firmly attached to said moving reference frame; at least one object transceiver assembly, firmly attached to said selected object, said at least one object transceiver assembly communicating with said at least one reference frame transceiver assembly using magnetic fields; an inertial measurement unit (IMU), firmly attached to said selected object, said IMU producing IMU inertial measurements of motion of said selected object with respect to an inertially fixed reference frame; an inertial navigation system (INS), firmly attached to said moving reference frame, said INS producing INS inertial measurements of motion of said moving reference frame with respect to said inertially fixed reference frame; and a tracking processor, coupled with said at least one object transceiver assembly, said IMU and said INS, said tracking processor receiving electromagnetic measurements resulting from the magnetic communication between said at least one reference frame transceiver assembly and said at least one object transceiver assembly, said tracking processor determining the position of said selected object relative to said moving reference frame by using said IMU inertial measurements and said INS inertial measurements to optimize said electromagnetic measurements; wherein said tracking processor includes a position estimator, a relative angular velocity estimator, an electromagnetic angular velocity estimator coupled with said position estimator, an angular velocity optimizer coupled with said relative angular velocity estimator and with said electromagnetic angular velocity estimator, and a filter module coupled with said position estimator, with said angular velocity optimizer, and with said relative angular velocity estimator, wherein said position estimator estimates the position of said at least one object transceiver assembly using electromagnetic tracking; wherein said electromagnetic angular velocity estimator estimates at least the angular velocity of said at least one object transceiver assembly based on said received electromagnetic measurements; wherein said relative angular velocity estimator estimates at least the relative angular velocity between said IMU and said INS; wherein said angular velocity optimizer receives an electromagnetic based angular velocity from said electromagnetic angular velocity estimator, and receives an inertial based angular velocity from said relative angular velocity estimator, and further optimally combines said electromagnetic based angular velocity and said inertial based angular velocity to obtain a final relative angular velocity; and wherein said filter module receives said final relative angular velocity from said angular velocity optimizer, and further determines at least the orientation of said selected object relative to a moving reference frame using said final relative angular velocity. 2. The apparatus according to claim 1, further including a sensor interface coupled with said at least one object transceiver assembly, aid sensor interface receiving said electromagnetic measurements from said at least one object transceiver assembly and providing said electromagnetic measurements to said tracking processor. 3. The apparatus according to claim 1, wherein said IMU inertial measurements of motion includes three angular velocity components and three linear acceleration components of said selected object with respect to an inertially fixed reference frame; and herein said INS inertial measurements of motion includes three angular velocity components and three linear acceleration components of said moving reference frame with respect to said inertially fixed reference frame. 4. Apparatus for determining the position of a selected object relative to a moving reference frame, the apparatus comprising: at least one reference frame transceiver assembly, firmly attached to said moving reference frame; at least one object transceiver assembly, firmly attached to said selected object, said at least one object transceiver assembly communicating with said at least one reference frame transceiver assembly using magnetic fields; an inertial measurement unit (IMU), firmly attached to said selected object, said IMU producing IMU inertial measurements of motion of said selected object with respect to an inertially fixed reference frame; an inertial navigation system (INS), firmly attached to said moving reference frame, said INS producing INS inertial measurements of motion of said moving reference frame with respect to said inertially fixed reference frame, and a tracking processor, coupled with said at least one object transceiver assembly, said IMU and said INS, said tracking processor receiving electromagnetic measurements resulting from the magnetic communication between said at least one reference frame transceiver assembly and said at least one object transceiver assembly, said tracking processor determining the position of said selected object relative to said moving reference frame by using said IMU inertial measurements and said INS inertial measurements to optimize said electromagnetic measurements, wherein said tracking processor includes a position estimator, a relative angular velocity estimator, and a filter module coupled with said position estimator and with said relative angular velocity estimator, wherein said position estimator estimates the position of said at least one object transceiver assembly using electromagnetic tracking; wherein said relative angular velocity estimator estimates at least the relative angular velocity between said IMU and said INS; and wherein said filter module integrates said relative angular velocity to obtain an inertial based orientation estimate, further receives an electromagnetic based orientation estimate from said position estimator, and further determines at least the orientation of said selected object relative to a moving reference frame from said electromagnetic based orientation estimate and said inertial based orientation estimate. 5. The apparatus according to claim 4, wherein said tracking processor thereby determines at least the orientation of said selected object relative to a moving reference frame by combining said electromagnetic measurements with a relative angular velocity obtained from said IMU inertial measurements and said INS inertial measurements. 6. The apparatus according to claim 4, wherein said relative angular velocity estimator further estimates the relative linear acceleration between said IMU and said INS; and wherein said filter module further double integrates said relative linear acceleration to obtain an inertial based location estimate, further receives an electromagnetic based location estimate from said position estimator, and further determines the location of said selected object relative to a moving reference frame from said electromagnetic based location estimate and said inertial based location estimate. 7. The apparatus according to claim 4, wherein said filter module adjusts the weight given to either of said electromagnetic based orientation estimate and said inertial based orientation estimate, depending on the level of confidence thereof. 8. Apparatus for determining the position of a selected object relative to a moving reference frame, the apparatus comprising: at least one reference frame transceiver assembly, firmly attached to said moving reference frame; at least one object transceiver assembly, firmly attached to said selected object, said at least one object transceiver assembly communicating with said at least one reference frame transceiver assembly using magnetic fields; an inertial measurement unit (IMU), firmly attached to said selected object, said IMU producing IMU inertial measurements of motion of said selected object with respect to an inertially fixed reference frame; an inertial navigation system (INS), firmly attached to said moving reference frame, said INS producing INS inertial measurements of motion of said moving reference frame with respect to said inertially fixed reference frame; and a tracking processor, coupled with said at least one object transceiver assembly, said IMU and said INS, said tracking processor receiving electromagnetic measurements resulting from the magnetic communication between said at least one reference frame transceiver assembly and said at least one object transceiver assembly, said tracking processor determining the position of said selected object relative to said moving reference frame by using said IMU inertial measurements and said INS inertial measurements to optimize said electromagnetic measurements, wherein said tracking processor includes a position optimizer unit, wherein said position optimizer unit receives said electromagnetic measurements and said inertial measurements, and determines the position of said selected object relative to a moving reference frame by minimizing a general cost function, said general cost function combining said electromagnetic measurements, said IMU inertial measurements and said INS inertial measurements in a single step. 9. The apparatus according to claim 8, wherein said tracking processor thereby determines the position of said selected object relative to a moving reference frame by combining said electromagnetic measurements, said IMU inertial measurements and said INS inertial measurements in a single step. 10. Method for determining the position of a selected object relative to a moving reference frame, the method comprising the procedures of: communicating using magnetic fields; producing IMU inertial measurements of motion of said selected object with respect to an inertially fixed reference frame; producing INS inertial measurements of motion of said moving reference frame with respect to said inertially fixed reference frame; receiving electromagnetic measurements resulting from the magnetic communication; determining the position of said selected object relative to said moving reference frame by using said IMU inertial measurements and said INS inertial measurements to optimize said electromagnetic measurements; wherein said procedure of receiving electromagnetic measurements resulting from the magnetic communication involves estimating the position of said selected object using electromagnetic tracking; and wherein said procedure of determining the position of said selected object involves: estimating at least the relative angular velocity of said selected object with respect to said moving platform; integrating the relative angular velocity estimate to obtain an inertial based orientation estimate of said selected object with respect to said moving platform; receiving an electromagnetic based orientation estimate; and determining at least an orientation of said selected object relative to a moving reference frame from said electromagnetic based orientation estimate and said inertial based orientation estimate. 11. The method to claim 10, wherein said IMU inertial measurements of motion includes three angular velocity components and three linear acceleration components of said selected object with respect to an inertially fixed reference frame; and wherein said INS inertial measurements of motion includes three angular velocity components and three linear acceleration components of said moving reference frame with respect to said inertially fixed reference frame. 12. The method according to claim 10, wherein said procedure of determining the position of said selected object involves combining electromagnetic measurements with a relative angular velocity obtained from inertial measurements. 13. The method according to claim 10, wherein said procedure of determining the position of said selected object involves: further estimating the relative linear acceleration of said selected object with respect to said moving platform; further double integrating the relative linear acceleration estimate to obtain an inertial based location estimate of said selected object with respect to said moving platform; further receiving an electromagnetic based location estimate; and further determining the location of said selected object relative to a moving reference frame from said electromagnetic based location estimate and said inertial based location estimate. 14. The method according to claim 10, wherein said procedure of determining the position of said selected object involves determining the position of said selected object relative to a moving reference frame by minimizing a general cost function, said general cost function combining said electromagnetic measurements and said inertial measurements in a single step. 15. The method according to claim 14, wherein said tracking processor thereby determines said procedure of determining the position of said selected object thereby involves determining the position of said selected object relative to a moving reference frame by combining said electromagnetic measurements, said IMU inertial measurements and said INS inertial measurements in a single step. 16. The method according to claim 10, further including the procedure of: performing harmonization of electromagnetic components, said harmonization involving receiving said electromagnetic measurements, an at least one IMU linear acceleration component of said selected object, an at least one INS linear acceleration component of said selected object, and a magnetic field model, and determining the orientation of a magnetic field model coordinate system with respect to the coordinate system of said moving reference frame by minimizing a general cost function. 17. The apparatus according to claim 1, wherein said filter module comprises a Kalman filter. 18. The apparatus according to claim 4, wherein said filter module comprises a Kalman filter.
연구과제 타임라인
LOADING...
LOADING...
LOADING...
LOADING...
LOADING...
이 특허에 인용된 특허 (27)
Teitel Michael A. ; Grimaud Jean-Jacques G., Absolute position tracker.
Igor Khalfin ; Herbert S. Jones, Jr., Electromagnetic position and orientation tracking system with distortion compensation employing wireless sensors.
Foxlin Eric M. (Cambridge MA), Inertial orientation tracker apparatus having automatic drift compensation for tracking human head and other similarly s.
Bachmann, Eric R.; McGhee, Robert B.; Yun, Xiaoping; Zyda, Michael J.; McKinney, Douglas L., Method and apparatus for motion tracking of an articulated rigid body.
Bachmann,Eric R.; McGhee,Robert B.; Yun,Xiaoping; Zyda,Michael J.; McKinney,Douglas L., Method and apparatus for motion tracking of an articulated rigid body.
Li, Rongsheng; Wu, Yeong-Wei Andy; Hein, Douglas H., System and method for calibrating inter-star-tracker misalignments in a stellar inertial attitude determination system.
Jeerage,Mahesh K.; Bye,Charles T.; Soehren,Wayne A., System and method for multiplexing and transmitting DC power, IMU data and RF data on a single cable.
Lee, Hyong Euk; Kim, Sang Hyun; Bang, Won Chul; Choi, Chang Kyu, Method and apparatus for estimating 3D position and orientation through sensor fusion.
Kirchner, William T.; Foote, Bobby D.; George, Christopher L.; Sattigeri, Ramachandra J., System and method for hybrid optical/inertial headtracking via numerically stable Kalman filter.
※ AI-Helper는 부적절한 답변을 할 수 있습니다.