Vehicle calibration and trajectory control system

• US 7,762,360 B2
• Filed: 02/20/2007
• Issued: 07/27/2010
• Est. Priority Date: 02/21/2006
• Status: Active Grant

• Current Assignee: Fabio Saposnik
• Original Assignee: Fabio Saposnik
• Inventors: Saposnik, Fabio
• Primary Examiner(s): Tran; Khoi
• Assistant Examiner(s): Amin; Bhavesh V
• Application Number:
  US11/676,758
• Publication Number:
  US 20070225891A1
• Time in Patent Office: 1,253 Days
• Field of Search: 180 62- 67
• US Class Current: 180/6.2
• CPC Class Codes: B60T 2270/303 Stability control with active acceleration
• CPC Class Codes: B60T 7/12 for automatic initiation; for initiation not subject to will of driver or passenger limiting speed of vehicles other than rail vehicles B60K31/00
• CPC Class Codes: B60T 8/1755 Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve road vehicle drive control systems for control of driving stability otherwise than by controlling a particular sub-unit B60W30/02
• CPC Class Codes: B60W 2520/14 Yaw
• CPC Class Codes: B60W 2540/18 Steering angle
• CPC Class Codes: B60W 2720/14 Yaw
• CPC Class Codes: B60W 40/105 Speed
• CPC Class Codes: B60W 40/11 Pitch movement
• CPC Class Codes: B60W 40/112 Roll movement
• CPC Class Codes: B60W 40/114 Yaw movement
• CPC Class Codes: B60Y 2200/25 Track vehicles
• CPC Class Codes: B62D 11/003 Electric or electronic control systems
• CPC Class Codes: B62D 11/04 by means of separate power sources

Abstract

A method and system are described for calibrating speed controls for a vehicle having a pair of drive means on opposite sides of the vehicle driven by independent speed controls and where relative speed of the drive means is used to direct the vehicle. In one aspect, angular motion of the vehicle is detected using at least one of a gyroscopic angular sensor and a pair of accelerometers to determine a rate of yaw; a speed control output for controlling the relative speed is adjusted so that the rate of yaw is lower than a threshold when speed control inputs for controlling the relative speed are equal; and one or more speed control adjustment parameters are determined and stored for use during operation for controlling the relative speed of the drive means. A microcontroller may be used to receive sensor outputs (e.g. from the gyroscope and/or accelerometers) and speed control inputs and to determine the speed control adjustment. During operation, the microcontroller may control the relative speed, applying the speed control adjustment(s) to speed control inputs.

Claims

1. A method of calibrating speed controls for a vehicle having a pair of drive means on opposite sides of the vehicle driven by independent speed controls and where relative speed of the drive means is used to direct the vehicle, the method comprising:

detecting angular motion of the vehicle using one of a gyroscopic angular sensor and a pair of accelerometers to determine a rate of yaw;

adjusting a speed control output for controlling relative speed so that the rate of yaw is lower than a threshold when speed control inputs for controlling the relative speed are equal; and

determining and storing at least one speed control adjustment for use during operation for controlling the relative speed of the drive means.

2. The method according to claim 1 comprising the step of determining automatically the deadband of each drive means.

3. The method according to claim 1 comprising the step of controlling the speed of the drive means using the at least one speed control adjustment.

4. The method according to claim 3 wherein when the speed control inputs are equal, the at least one speed control adjustment is applied so that the vehicle automatically tracks straight.

5. The method according to claim 3 comprising receiving a trajectory for defining a direction for the vehicle and automatically controlling an angular speed of the vehicle in response to the trajectory.

6. The method according to claim 1 comprising:

activating a calibration mode to perform the steps of detecting, adjusting and determining and storing; and

deactivating the calibration mode when completed.

7. A system for calibrating speed controls for a vehicle having a pair of drive means on opposite sides of the vehicle driven by independent speed controls and where relative speed of the drive means is used to direct the vehicle, the system comprising:

at least one of a gyroscopic angular sensor and a pair of accelerometers outputting signals for determining angular motion of the vehicle;

a controller configured to receive speed control inputs for each drive means and the signals for determining angular motion to determine the rate of yaw and to send speed control outputs to control the speed of each drive means, said controller further configured to;

adjust a speed control output for controlling relative speed so that the rate of yaw is lower than a threshold when speed control inputs received for controlling the relative speed are equal; and

determine and store at least one speed control adjustment for use during operation for controlling the relative speed of the drive means.

8. The system according to claim 7 wherein the controller is configured to determine a deadband of each drive means.

9. The system according to claim 7 wherein the controller is configured to control the speed of the drive means using the at least one speed control adjustment.

10. The system according to claim 9 wherein said controller is configured to adjust said speed control inputs received using said at least one speed control adjustment and output the adjusted speed control inputs to a drive means controller for driving the vehicle.

11. The system claim according to claim 7 wherein the controller is configured to receive a trajectory for defining a direction of the machine and further configured to steer the vehicle along the trajectory, modifying its response to the sensor signals as a function of one or more of time and distance traversed.

12. A computer program product storing instructions and data for configuring a controller to execute operations to:

detect angular motion of the vehicle using one at least one of a gyroscopic angular sensor and a pair of accelerometers to determine a rate of yaw;

adjust a speed control output for controlling relative speed so that the rate of yaw is lower than a threshold when speed control inputs for controlling the relative speed are equal; and

determine and store at least one speed control adjustment for use during operation for controlling the relative speed of the drive means.

13. A method of calibrating speed controls for a vehicle having a pair of drive means on opposite sides of the vehicle driven by independent speed controls and where relative speed of the drive means is used to direct the vehicle, the method comprising:

detecting angular motion of the vehicle using at least one of a gyroscope and a pair of accelerometers;

receiving speed control inputs for controlling relative speed, the speed control inputs adjusted by an operator so that the angular motion is lower than a threshold defining when the vehicle is tracking straight; and

determining and storing at least one speed control adjustment for use during operation for controlling the relative speed of the drive means such that when speed control inputs for controlling the relative speed are equal, the vehicle tracks straight.

14. The method according to claim 13 comprising indicating when the vehicle is tracking straight.

15. The method according to claim 13 wherein the method steps are performed during a calibration mode and said step of determining and storing is performed according to one of:

(i) automatically when the vehicle is tracking straight; and

(ii) upon operator direction when the vehicle is tracking straight.

16. A system for calibrating speed controls for a vehicle having a pair of drive means on opposite sides of the vehicle driven by independent speed controls and where relative speed of the drive means is used to direct the vehicle, the system comprising:

at least one of a gyroscopic angular sensor and a pair of accelerometers outputting signals for determining angular motion of the vehicle;

a controller configured to receive speed control inputs for each drive means and the signals for determining angular motion to determine the rate of yaw and to send speed control outputs to control the speed of each drive means, said controller further configured to;

detect angular motion of the vehicle using the output signals;

receive the speed control inputs for controlling relative speed where the speed control inputs are adjusted by an operator so that the angular motion is lower than a threshold defining when the vehicle is tracking straight; and

determine and store at least one speed control adjustment for use during operation for controlling the relative speed of the drive means such that when speed control inputs for controlling the relative speed are equal, the vehicle tracks straight.