Systems and methods for navigating vehicles with redundant navigation systems
Systems, methods, and non-transitory computer-readable media can receive sensor data providing information about an environment surrounding a vehicle to a first computing system and a second computing system associated with the vehicle, wherein the first computing system and the second computing system are each capable of generating navigation instructions for the vehicle based on the received sensor data. A first planned trajectory is determined based on the sensor data by the first computing system. The vehicle is navigated by the first computing system based on the first planned trajectory. Control of the vehicle is transitioned from the first computing system to the second computing system based on a failure associated with the first computing system. An emulated trajectory is determined based on data describing a current motion of the vehicle by the second computing system. The vehicle is navigated by the second computing system based on the emulated trajectory.
1. A computer-implemented method comprising:
receiving sensor data from a plurality of sensors configured to provide information about an environment surrounding a vehicle to at least a first computing system and a second computing system of the vehicle, wherein the first computing system and the second computing system generate navigation instructions for the vehicle based, at least in part, on the received sensor data;
navigating, by the first computing system, the vehicle based, at least in part, on a first planned trajectory;
transitioning control of the vehicle to the second computing system responsive to a failure associated with the first computing system;
determining, by the second computing system, an emulated trajectory according to data describing a current motion of the vehicle, wherein determining the emulated trajectory includes extrapolating the current motion as indicated by a current state of a vehicle motion control component; and
navigating, by the second computing system, the vehicle based on the emulated trajectory.
2. The computer-implemented method of claim 1 , further comprising:
determining, by the second computing system, a second planned trajectory based on the sensor data.
3. The computer-implemented method of claim 1 , wherein the emulated trajectory is generated faster than a time required for the second computing system to generate a new planned trajectory from the sensor data.
4. The computer-implemented method of claim 1 , wherein the vehicle motion control component includes an actuator that controls one of a steering wheel, a brake, and an accelerator of the vehicle.
5. The computer-implemented method of claim 1 , wherein the failure is determined by at least one health monitor associated with the first computing system.
6. The computer-implemented method of claim 5 , wherein the failure is detected by the health monitor; and
in response, transitioning control of the vehicle to the second computing system based on the failure, wherein the first computing system is a primary computing system and the second computing system is a backup computing system.
7. The computer-implemented method of claim 1 , wherein the first computing system does not provide the second computing system with the first planned trajectory.
8. The computer-implemented method of claim 4 , wherein the vehicle motion control component is configured to control at least one of a brake, an accelerator, an engine, or a steering wheel, and wherein the emulated trajectory is determined based on information provided by the vehicle motion control component.
9. The computer-implemented method of claim 8 , wherein the extrapolation is a linear extrapolation determined based on parameters associated with the vehicle motion control components including at least one of angle, power, speed, torque, or derivatives of the parameters.
10. The computer-implemented method of claim 9 , wherein the linear extrapolation reflects an instantaneous velocity of the vehicle at a time of the transition of control.
11. A system comprising:
at least one processor; and
a memory storing instructions that, when executed by the at least one processor, cause the system to perform:
receiving sensor data from a plurality of sensors configured to provide information about an environment surrounding a vehicle to at least a first computing system and a second computing system of the vehicle, wherein the first computing system and the second computing system generate navigation instructions for the vehicle based, at least in part, on the received sensor data;
navigating, by the first computing system, the vehicle based, at least in part, on a first planned trajectory;
transitioning control of the vehicle to the second computing system responsive to a failure associated with the first computing system;
determining, by the second computing system, an emulated trajectory according to data describing a current motion of the vehicle, wherein determining the emulated trajectory includes extrapolating the current motion as indicated by a current state of a vehicle motion control component; and
navigating, by the second computing system, the vehicle based on the emulated trajectory.
12. The system of claim 11 , wherein the emulated trajectory is generated faster than a time required for the second computing system to generate a new planned trajectory from the sensor data.
13. The system of claim 11 , wherein the vehicle motion control component includes an actuator that controls one of a steering wheel, a brake, and an accelerator of the vehicle.
14. The system of claim 13 , wherein at least one vehicle motion control component is configured to control at least one of a brake, an accelerator, an engine, or a steering wheel, and wherein the emulated trajectory is determined based on information provided by the vehicle motion control component.
15. The system of claim 14 , wherein the extrapolation is a linear extrapolation determined based on parameters associated with the vehicle motion control components including at least one of angle, power, speed, torque, or derivatives of the parameters.
16. A non-transitory computer-readable storage medium including instructions that, when executed by at least one processor of a computing system, cause the computing system to perform a method comprising:
receiving sensor data from a plurality of sensors configured to provide information about an environment surrounding a vehicle to at least a first computing system and a second computing system of the vehicle, wherein the first computing system and the second computing system generate navigation instructions for the vehicle based, at least in part, on the received sensor data;
navigating, by the first computing system, the vehicle based, at least in part, on a first planned trajectory;
transitioning control of the vehicle to the second computing system response to a failure associated with the first computing system;
determining, by the second computing system, an emulated trajectory according to data describing a current motion of the vehicle, wherein determining the emulated trajectory includes extrapolating the current motion as indicated by a current state of a vehicle motion control component; and
navigating, by the second computing system, the vehicle based on the emulated trajectory.
17. The non-transitory computer-readable storage medium of claim 16 , wherein the emulated trajectory is generated faster than a time required for the second computing system to generate a new planned trajectory from the sensor data.
18. The non-transitory computer-readable storage medium of claim 16 , wherein the vehicle motion control component includes an actuator that controls one of a steering wheel, a brake, and an accelerator of the vehicle.
19. The non-transitory computer-readable storage medium of claim 18 , wherein the vehicle motion control component is configured to control at least one of a brake, an accelerator, an engine, or a steering wheel, and wherein the emulated trajectory is determined based on information provided by the vehicle motion control component.
20. The non-transitory computer-readable storage medium of claim 19 , wherein the extrapolation is a linear extrapolation determined based on parameters associated with the vehicle motion control components including at least one of angle, power, speed, torque, or derivatives of the parameters.