System for and method of determining angular position of a vehicle

• US 9,791,279 B1
• Filed: 06/30/2016
• Issued: 10/17/2017
• Est. Priority Date: 06/30/2016
• Status: Active Grant

• Current Assignee: U-Blox AG (u-blox Holding AG)
• Original Assignee: U-Blox AG (u-blox Holding AG)
• Inventors: Somieski, Alexander
• Primary Examiner(s): Kiswanto, Nicholas
• Assistant Examiner(s): Taveras, Kenny A
• Application Number:
  US15/199,024
• Time in Patent Office: 474 Days
• Field of Search: None
• CPC Class Codes: B60T 8/24 responsive to vehicle inclination or change of direction, e.g. negotiating bends using electrical circuitry or regulation means B60T8/17
• CPC Class Codes: B60W 2520/105 Longitudinal acceleration
• CPC Class Codes: B60W 2520/125 Lateral acceleration
• CPC Class Codes: B60W 2520/14 Yaw
• CPC Class Codes: B60W 2520/16 Pitch
• CPC Class Codes: B60W 2520/18 Roll
• CPC Class Codes: B60W 2552/15 Road slope, i.e. the inclination of a road segment in the longitudinal direction
• CPC Class Codes: B60W 40/10 related to vehicle motion
• CPC Class Codes: G01C 21/12 executed aboard the object being navigated; Dead reckoning
• CPC Class Codes: G01C 21/165 combined with non-inertial navigation instruments
• CPC Class Codes: G01C 9/00 Measuring inclination, e.g. by clinometers, by levels
• CPC Class Codes: G01C 9/06 Electric or photoelectric indication or reading means

Abstract

A system for and method of determining angular position (e.g. pitch) of a vehicle. In accordance with an embodiment, a first angular rate of rotation of the vehicle about a first axis of rotation is detected using a first angular rate sensor mounted to the vehicle. A second angular rate of rotation of the vehicle about a second axis of rotation is detected using a second angular rate sensor mounted to the vehicle. The second axis of rotation is substantially orthogonal to the first axis of rotation. The angular position of the vehicle is determined based on a ratio of the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle.

Claims

1. A method of determining an angular position of a vehicle, comprising:

detecting a first angular rate of rotation of the vehicle about a first axis of rotation using a first angular rate sensor mounted to the vehicle;

detecting a second angular rate of rotation of the vehicle about a second axis of rotation using a second angular rate sensor mounted to the vehicle, the second axis of rotation being substantially orthogonal to the first axis of rotation wherein said first axis of rotation coincides with a roll axis of the vehicle and said second axis of rotation coincides with a yaw axis of the vehicle and wherein the vehicle experiences a rate of change of rotation about the first axis that is negligible while said detecting the first angular rate of rotation of the vehicle and said detecting the second angular rate of rotation of the vehicle are performed; and

estimating the angular position of the vehicle based on a ratio of the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle.

2. The method according to claim 1, wherein the angular position comprises a pitch of the vehicle.

3. The method according to claim 1, wherein said detecting the first angular rate of rotation of the vehicle and said detecting the second angular rate of rotation of the vehicle are performed simultaneously while the vehicle experiences significant rate of change of rotation about the second axis.

4. The method according to claim 1, wherein the vehicle travels upon a curved ramp while said detecting the first angular rate of rotation of the vehicle and said detecting the second angular rate of rotation of the vehicle are performed.

5. The method according to claim 1, further comprising:

storing a first parameter representative of the first angular rate of rotation of the vehicle in a computer-readable data storage; and

storing a second parameter representative of the second angular rate of rotation of the vehicle in the computer-readable data storage.

6. The method according to claim 5, wherein said estimating the angular position of the vehicle is performed by a processor using the first parameter representative of the first angular rate of rotation of the vehicle and the second parameter representative of the second angular rate of rotation of the vehicle.

7. The method according to claim 1, wherein said estimating the angular position of the vehicle comprises determining the inverse tangent of a ratio of said first angular rate of rotation and said second angular rate of rotation.

9. The method according to claim 2, further comprising estimating a change in altitude of the vehicle using the estimated pitch of the vehicle.

10. The method according to claim 2, further comprising estimating a position of the vehicle in three dimensions using the estimated pitch of the vehicle.

11. The method according to claim 1, further comprising calibrating an alignment of the first and second angular rate sensors with the vehicle.

12. The method according to claim 11, wherein said calibrating the alignment is performed periodically when GNSS signals are available.

8. A method of determining an angular position of a vehicle, comprising:

detecting a first angular rate of rotation of the vehicle about a first axis of rotation using a first angular rate sensor mounted to the vehicle;

detecting a second angular rate of rotation of the vehicle about a second axis of rotation using a second angular rate sensor mounted to the vehicle, the second axis of rotation being substantially orthogonal to the first axis of rotation; and

estimating the angular position of the vehicle based on a ratio of the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle, wherein the angular position comprises pitch of the vehicle, said estimating being performed in accordance with;

13. A method of determining an angular position of a vehicle, comprising:

detecting a first angular rate of rotation of the vehicle about a first axis of rotation using a first angular rate sensor mounted to the vehicle;

detecting a second angular rate of rotation of the vehicle about a second axis of rotation using a second angular rate sensor mounted to the vehicle, the second axis of rotation being substantially orthogonal to the first axis of rotation;

estimating the angular position of the vehicle based on a ratio of the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle, wherein the angular position comprises pitch of the vehicle; and

resolving a rate of change of heading of the vehicle using the estimated pitch of the vehicle.

14. The method according to claim 13, wherein said resolving the rate of change of heading is performed only when a yaw rate of the vehicle exceeds a threshold yaw rate value.

15. An apparatus configured to be mountable to a vehicle for determining an angular position of the vehicle, comprising:

a first angular rate sensor configured to detect a first angular rate of rotation of the vehicle about a first axis of rotation;

a second angular rate sensor configured to detect a second angular rate of rotation of the vehicle about a second axis of rotation, the second axis of rotation being substantially orthogonal to the first axis of rotation wherein said first axis of rotation coincides with a roll axis of the vehicle and said second axis of rotation coincides with a yaw axis of the vehicle and wherein the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle are detected simultaneously while the vehicle experiences a rate of change of rotation about the first axis that is negligible; and

a processor configured to estimate the angular position of the vehicle based on a ratio of the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle.

16. The apparatus according to claim 15, wherein the angular position comprises a pitch of the vehicle.

17. The apparatus according to claim 15, wherein the angular position comprises a roll of the vehicle.

18. The apparatus according to claim 15, wherein the apparatus is configured to detect the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle while the vehicle travels upon a curved ramp.

19. The apparatus according to claim 15, further comprising a computer-readable date storage configured to store a first parameter representative of the first angular rate of rotation of the vehicle and a second parameter representative of the second angular rate of rotation of the vehicle.

20. The apparatus according to claim 19, wherein the processor is configured to estimate the angular position of the vehicle using the first parameter representative of the first angular rate of rotation of the vehicle and the second parameter representative of the second angular rate of rotation of the vehicle.

21. The apparatus according to claim 15, wherein the processor is configured to estimate the angular position of the vehicle by determining the inverse tangent of the ratio of said first angular rate of rotation and said second angular rate of rotation.

22. The apparatus according to claim 16, wherein the processor is configured to estimate the pitch of the vehicle in accordance with:

23. The apparatus according to claim 16, wherein the processor is configured to estimate a change in altitude of the vehicle using the estimated pitch of the vehicle.

24. The apparatus according to claim 16, wherein the processor is configured to estimate a position of the vehicle in three dimensions using the estimated pitch of the vehicle.

25. The apparatus according to claim 15, wherein the processor is configured to calibrate an alignment of the first and second angular rate sensors with the vehicle.

26. The apparatus according to claim 25, wherein the processor is configured to calibrate the alignment periodically when GNSS signals are available.

27. An apparatus configured to be mountable to a vehicle for determining an angular position of the vehicle, comprising:

a first angular rate sensor configured to detect a first angular rate of rotation of the vehicle about a first axis of rotation;

a second angular rate sensor configured to detect a second angular rate of rotation of the vehicle about a second axis of rotation, the second axis of rotation being substantially orthogonal to the first axis of rotation; and

a processor configured to estimate the angular position of the vehicle based on a ratio of the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle, wherein the angular position comprises a pitch of the vehicle and the processor is configured to resolve a rate of change of heading of the vehicle using the estimated pitch of the vehicle.

28. The apparatus according to claim 27, wherein the processor is configured to resolve the rate of change of heading using the estimated pitch of the vehicle only when a yaw rate of the vehicle exceeds a threshold yaw rate value.

29. A method of determining an angular position of a vehicle, comprising:

detecting a first angular rate of rotation of the vehicle about a first axis of rotation using a first angular rate sensor mounted to the vehicle;

detecting a second angular rate of rotation of the vehicle about a second axis of rotation using a second angular rate sensor mounted to the vehicle, the second axis of rotation being substantially orthogonal to the first axis of rotation;

estimating the pitch of the vehicle using the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle; and

estimating a change in location of the vehicle using the estimated pitch of the vehicle, said estimating being performed in accordance with;

31. The method according to claim 29, wherein the vehicle experiences a rate of change of rotation about the first axis that is negligible while said detecting the first angular rate of rotation of the vehicle and said detecting the second angular rate of rotation of the vehicle are performed.

32. The method according to claim 29, further comprising resolving a rate of change of heading of the vehicle using the estimated pitch of the vehicle.

30. An apparatus configured to be mountable to a vehicle for determining an angular position of the vehicle, comprising:

a first angular rate sensor configured to detect a first angular rate of rotation of the vehicle about a first axis of rotation;

a second angular rate sensor configured to detect a second angular rate of rotation of the vehicle about a second axis of rotation, the second axis of rotation being substantially orthogonal to the first axis of rotation; and

a processor configured to estimate the pitch of the vehicle using the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle and the processor configured to estimate a change in location of the vehicle using the estimated pitch of the vehicle, wherein the processor is configured to estimate the pitch of the vehicle in accordance with;

33. The apparatus according to claim 30, wherein the apparatus is configured to detect the first angular rate of rotation of the vehicle and the second angular rate of rotation of the vehicle simultaneously while the vehicle experiences a rate of change of rotation about the first axis that is negligible.

34. The apparatus according to claim 30, wherein the processor is configured to resolve a rate of change of heading of the vehicle using the estimated pitch of the vehicle.