Reference tracking for two autonomous driving modes using one control scheme
Systems and methods of using a common control scheme to autonomously controlling a vehicle during semi-autonomous and fully autonomous driving modes are provided. In particular, embodiments of the presently disclosed technology incorporate reference tracking for driving input and vehicle state into this common control scheme. In some embodiments, this common control scheme may be implemented using Model Predictive Control (MPC).
1. A vehicle having a semi-autonomous and a fully autonomous driving mode, the vehicle comprising:
one or more processors configured to execute machine executable instructions in non-transitory memory to:
in response to receiving a driving input and a vehicle state for a defined time horizon, determine a reference driving input and a reference vehicle state for the defined time horizon, wherein the driving input is a human driver input when the vehicle is operating in a semi-autonomous mode and a pseudo-driver input when the vehicle is operating in a fully autonomous mode;
compare the driving input and the reference driving input to an autonomous driving command and the reference vehicle state to the vehicle state;
compute a second autonomous driving command based on the comparing; and
generate a control signal which effectuates the second autonomous driving command.
2. The vehicle of claim 1 , wherein:
comparing the reference driving input to the autonomous driving command comprises comparing the reference driving input to the autonomous driving command within a first term of an objective cost function;
comparing the driving input to the autonomous driving command comprises comparing the driving input to the autonomous driving command within a second term of the objective cost function;
comparing the reference vehicle state to the vehicle state comprises comparing the reference vehicle state to the vehicle state within a third term of the objective cost function; and
the second autonomous driving command reduces the objective cost function.
3. The vehicle of claim 2 , wherein the objective cost function further comprises a fourth term containing a slack variable.
4. The vehicle of claim 1 , wherein the vehicle state comprises a data associated with the current operational state of the vehicle.
5. The vehicle of claim 4 , wherein the vehicle state further comprises one or more data associated with predicted future operational states of the vehicle.
6. The vehicle of claim 1 , wherein:
the human driver input comprises a current human driver command and one or more predicted human driver commands for the defined time horizon; and
the pseudo-driver input comprises one or more predicted pseudo-driver commands for the defined time horizon.
7. The vehicle of claim 6 , wherein the current human driver command comprises one or more commands a human driver in the vehicle places on one or more motive systems of the vehicle.
8. The vehicle of claim 7 , wherein the current human driver command comprises a lateral force command placed on the steering system of the vehicle.
9. The vehicle of claim 1 , wherein the pseudo-driver input is a stabilizing prediction steering command.
10. The vehicle of claim 9 , wherein the stabilizing prediction steering command is a stable lane keeping feedforward command.
11. A vehicle having a semi-autonomous and a fully autonomous driving mode, the vehicle comprising:
one or more processors; and
memory operatively connected to the one or more processors and including computer code, that when executed by the one or more processors, causes the vehicle to:
in response to receiving a driving input for a defined time horizon, determine a reference driving input for the defined time horizon, wherein the driving input is a human driver input when the vehicle is operating in a semi-autonomous mode and a pseudo-driver input when the vehicle is operating in a fully autonomous mode;
compare the reference driving input to an autonomous driving command;
compute a second autonomous driving command based on the comparing; and
generate a control signal which effectuates the second autonomous driving command.
12. The vehicle of claim 11 , wherein:
comparing the reference driving input to the autonomous driving command comprises comparing the reference driving input to the autonomous driving command within a term of an objective cost function; and
the second autonomous driving command reduces the objective cost function.
13. The vehicle of claim 12 , wherein:
the human driver input comprises a current human driver command and one or more predicted human driver commands for the defined time horizon; and
the pseudo-driver input comprises one or more predicted pseudo-driver commands for the defined time horizon.
14. The vehicle of claim 13 , wherein the current human driver command comprises one or more commands a human driver in the vehicle places on one or more motive systems of the vehicle.
15. The vehicle of claim 14 , wherein the current human driver command comprises a lateral force command placed on a steering system of the vehicle.
16. The vehicle of claim 12 , wherein the pseudo-driver input is a stabilizing prediction steering command.
17. The vehicle of claim 16 , wherein the stabilizing prediction steering command is a stable lane keeping feedforward command.
18. A method for controlling a vehicle having a semi-autonomous mode and a fully autonomous mode, the method comprising:
in response to receiving a driving input and a vehicle state for a defined time horizon, determining a reference driving input and a reference vehicle state for the defined time horizon, wherein the driving input is a human driver input when the vehicle is operating in a semi-autonomous mode and a pseudo-driver input when the vehicle is operating in a fully autonomous mode;
comparing the reference driving input to an autonomous driving command and the reference vehicle state to the vehicle state;
computing a second autonomous driving command based on the comparing; and
generating a control signal which effectuates the second autonomous driving command.
19. The method of claim 8 , wherein:
comparing the reference driving input to the autonomous driving command comprises comparing the reference driving input to the autonomous driving command within a first term of an objective cost function;
comparing the reference vehicle state to the vehicle state comprises comparing the reference vehicle state to the vehicle state within a second term of the objective cost function; and
the second autonomous driving command reduces the objective cost function.
20. The method of claim 19 , wherein the reference driver input is the human driver input when the vehicle is in the semi-autonomous mode.