Autonomous behaviors for a remote vehicle
View Patent ↗A system for allowing an operator to switch between remote vehicle tele-operation and one or more remote vehicle autonomous behaviors. The system comprises: an operator control unit receiving input from the operator including instructions for the remote vehicle to execute an autonomous behavior; a control system on the remote vehicle for receiving the instruction to execute an autonomous behavior from the operator control unit; and a GPS receiver, an inertial measurement unit, and a navigation CPU on the remote vehicle. Upon receiving the instruction to execute an autonomous behavior, the remote vehicle executes that autonomous behavior using input from the GPS receiver, the inertial measurement unit (IMU), and the navigation CPU.
1. A method for performing a retrotraverse behavior for a remote vehicle, the method comprising:
determining, by a processor, whether the retrotraverse is active;
if the retrotraverse behavior is active;
erasing previously-used waypoints;
determining a current position of the remote vehicle and a current time, and pre-pending the current position and the current time to a list of time stamped waypoints;
generating additional waypoints and adding them to the list of time stamped waypoints;
storing the list of time stamped waypoints;
determining whether a control signal has been received from an operator control unit;
if the control signal has not been received from the operator control unit;
setting a retrotraverse start time to the current time;
generating a return path interconnecting previously-traversed waypoints in reverse order of timestamps;
navigating the remote vehicle along the return path until the control signal is received from the operator control unit; and
setting a retrotraverse end time to the current time.
2. The method of claim 1 , wherein the time stamped waypoints are separated by at least a minimum difference in time and distance.
3. The method of claim 1 , further comprising maintaining a list of previously-performed retrotraverses by recording a list of start time and end time pairs for each retrotraverse period of time.
4. The method of claim 3 , further comprising excluding waypoints recorded during previously-performed retrotraverses from the return path.
5. The method of claim 4 , further comprising excluding waypoints recorded during previously-performed retrotraverses by excluding waypoints recorded between the start time and end time pairs for each previously-performed retrotraverse.
6. The method of claim 3 , further comprising excluding waypoints traversed during previously-performed retrotraverses from the return path.
7. The method of claim 1 , further comprising determining the remote vehicle's position using odometry.
8. The method of claim 1 , further comprising determining the remote vehicle's position using one or more of a global positioning system or navigation beacon points.