Patent
Compensation for mounting misalignment of a navigation device
العنوان: | Compensation for mounting misalignment of a navigation device |
---|---|
Patent Number: | 8,086,405 |
تاريخ النشر: | December 27, 2011 |
Appl. No: | 11/823964 |
Application Filed: | June 28, 2007 |
مستخلص: | Compensating for the misalignment of a navigation device with respect to a vehicle is described. In one example, the compensation is made by applying a high pass filter to a measured acceleration of the vehicle to produce a motion acceleration signal, weighting the motion acceleration signal with a measured steering rate of the vehicle, and deriving misalignment parameters for the navigation device with respect to the vehicle using the weighted motion acceleration signal. |
Inventors: | Han, Shaowei (Palo Alto, CA, US); Niu, Xiaoji (Shanghai, CN); Ma, Changlin (Cupertino, CA, US) |
Assignees: | SiRF Technology Holdings, Inc. (San Jose, CA, US) |
Claim: | 1. A method to determine a misalignment of a navigation device with respect to a vehicle comprising: applying a high pass filter to a measured acceleration of the vehicle to produce a motion acceleration signal; weighting the motion acceleration signal with a measured steering rate of the vehicle; and deriving, using a processor, misalignment parameters for the navigation device with respect to the vehicle using the weighted motion acceleration signal. |
Claim: | 2. The method of claim 1 , further comprising: determining if the vehicle is moving; applying a low pass filter to the measured acceleration while the vehicle is moving to produce a gravity signal; and wherein deriving misalignment parameters comprises also using the gravity signal. |
Claim: | 3. The method of claim 1 , wherein deriving misalignment parameters comprises applying a Kalman filtering system. |
Claim: | 4. The method of claim 1 , wherein weighting comprises; generating a proportional weighting factor from the measured steering rate; and multiplying the motion acceleration signal with the proportional weighting factor to produce a centrifugal acceleration component of the motion acceleration signal. |
Claim: | 5. The method of claim 1 , wherein weighting comprises; generating an inverse proportional weighting factor from the measured steering rate; and multiplying the motion acceleration signal with the inverse proportional weighting factor to produce a forward acceleration component of the motion acceleration signal. |
Claim: | 6. The method of claim 2 , wherein weighting comprises using the measured steering rate to weight the motion acceleration signal so that a centrifugal acceleration and a forward acceleration are produced, and wherein deriving misalignment parameters comprises using a Kalman filtering system to produce three misalignment angles based on the gravity signal, the centrifugal acceleration signal and the forward acceleration signals. |
Claim: | 7. The method of claim 1 , further comprising correcting raw sensor data using correction angles obtained from the derived misalignment parameters. |
Claim: | 8. The method of claim 7 , further comprising determining new misalignment parameters after correcting the raw sensor data and correcting the raw sensor data again using the new misalignment parameters. |
Claim: | 9. The method of claim 8 , further comprising determining the location of the vehicle after correcting. |
Claim: | 10. The method of claim 9 wherein determining the location comprises determining the location using a satellite positioning system. |
Claim: | 11. The method of claim 1 , further comprising using odometer signals from the vehicle to determine whether the motion acceleration signal corresponds to the vehicle being in motion. |
Claim: | 12. The method of claim 1 , further comprising measuring the acceleration along three orthogonal axes using a three axis accelerometer to produce the measured acceleration. |
Claim: | 13. The method of claim 1 , further comprising receiving a measured acceleration from an external sensor. |
Claim: | 14. The method of claim 1 , further comprising measuring the steering rate using a vertical gyroscope. |
Claim: | 15. The method of claim 1 , wherein the misalignment parameters comprise misalignment correction angles corresponding to the misalignment between the navigation device and the vehicle. |
Current U.S. Class: | 701/216 |
Patent References Cited: | 4127249 November 1978 Lambregts 4321678 March 1982 Krogmann 5422817 June 1995 Tazates et al. 5878357 March 1999 Sivashankar et al. 5890093 March 1999 Mark et al. 5928309 July 1999 Korver et al. 6097337 August 2000 Bisio 6151551 November 2000 Geier et al. 6282496 August 2001 Chowdhary 6285954 September 2001 Mark et al. 6446005 September 2002 Bingeman et al. 6532419 March 2003 Begin et al. 6622091 September 2003 Perlmutter et al. 6647352 November 2003 Horton 6782315 August 2004 Lu 6801855 October 2004 Walters et al. 6915205 July 2005 Kim et al. 6931322 August 2005 Jung et al. 7124026 October 2006 Hong 7248964 July 2007 Bye 7286933 October 2007 Cho 7337650 March 2008 Preston et al. 7392116 June 2008 Kesselgruber 7400946 July 2008 Lee et al. 7430367 September 2008 Imada 7437230 October 2008 McClure et al. 2002/0022924 February 2002 Begin 2004/0027278 February 2004 Park 2004/0036650 February 2004 Morgan 2004/0044477 March 2004 Jung et al. 2004/0181335 September 2004 Kim et al. 2004/0215380 October 2004 Song 2005/0137800 June 2005 Hong 2006/0100781 May 2006 Lin et al. 2006/0165398 July 2006 Imada WO00/17601 March 2000 WO/02/18873 March 2002 WO02/018873 July 2002 WO2007/059134 May 2007 |
Other References: | Bar-Itzhack I Y, Oshman Y. (1985). “Attitude Determination from Vector Observations: Quaternion Estimation”, IEEE Transactions on Aerospace and Electronic Systems, 1985, v AES-21(1): 128-136. cited by other Gao Z Y, Niu X J, Guo M F.(2002) “Quaternion-based Kalman Filter for Micro-machined Strapdown Attitude Heading Reference System”, Chinese Journal of Aeronautics, Aug. 2002, 15(3): 171-175. cited by other Creamer Glen, (1996) “Spacecraft Attitude Determination Using Gyros and Quaternion Measurements”, Journal of the Astronautical Sciences, 1996, 44(3): 357-371. cited by other Lefferts E J, Markley F L, Shuster M D (1982), “Kalman Filtering for Spacecraft Attitude Estimation”, Journal of Guidance, Control, and Dynamics, 1982, 5(5): 417-429. cited by other Maybeck, Peter S. (1979), “Stochastic Models, Estimation and Control” (vol. 1), New York: Academic Press, 1979. cited by other |
Assistant Examiner: | Khatib, Rami |
Primary Examiner: | Elchanti, Hussein A. |
Attorney, Agent or Firm: | Pillsbury Winthrop Shaw Pittman LLP |
رقم الانضمام: | edspgr.08086405 |
قاعدة البيانات: | USPTO Patent Grants |
الوصف غير متاح. |