Agricultural autopilot steering compensation
View Patent ↗Agricultural autopilot steering compensation provides improved steering control when steerable wheels lose traction and/or in tight turns.
1. A method for guiding a vehicle along a path comprising:
providing an autopilot system including:
position, velocity and heading sensors; and,
steering actuators and drive wheel torque actuators;
estimating a state of the vehicle by digitally filtering data provided by the sensors; and,
reducing heading and cross-track errors between the state of the vehicle and a pre-programmed path by operating the steering actuators and the drive wheel torque actuators in response to a function of the errors.
2. The method of claim 1 wherein the function of the errors is proportional to the magnitude of the errors.
3. The method of claim 1 wherein the function of the errors is the time integral of the errors.
4. The method of claim 1 wherein the function of the errors is the time derivative of the errors.
5. The method of claim 1 wherein the function of the errors includes a threshold error value.
6. An agricultural autopilot comprising:
a steering wheel sensor;
steering actuators and drive wheel torque actuators; and,
a microprocessor and memory that:
i. estimate a desired steering angle based on data provided by the sensor and a digital filter,
ii. operate the steering actuators and the drive wheel torque actuators to achieve an effective steering angle equal to the desired steering angle when the desired steering angle is less than or equal to an actual steering angle mechanical limit, and,
iii. operate the steering actuators and the drive wheel torque actuators to achieve an effective steering angle greater than the actual steering angle when the desired steering angle is greater than the actual steering angle mechanical limit.
7. The autopilot of claim 6 wherein the drive wheel torque actuators include individual drive wheel brakes.
8. The autopilot of claim 6 wherein the drive wheel torque actuators include individual drive wheel electric motors.
9. The autopilot of claim 6 wherein the drive wheel torque actuators include individual drive wheel hydraulic motors.
10. A method for assisting an agricultural vehicle operator comprising:
providing an autopilot system including:
a steering wheel sensor; and,
steering actuators and drive wheel torque actuators;
estimating a desired steering angle based on data provided by the sensor and a digital filter;
operating the steering actuators and the drive wheel torque actuators to achieve an effective steering angle equal to the desired steering angle when the desired steering angle is less than or equal to an actual steering angle mechanical limit; and,
operating the steering actuators and the drive wheel torque actuators to achieve an effective steering angle greater than the actual steering angle when the desired steering angle is greater than the actual steering angle mechanical limit.