#should be 8 hour mission, set timer to 8 hours
#set timeout in seconds
behavior missionTimer {
timeOut = 23000;
}

behavior depthEnvelope {
  minDepth = 0;
  maxDepth = 170;
  abortDepth = 180;
}

#end of first lap

# acquire gps fix
behavior getgps {
duration = 4000;
minHits = 3600;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = rudder;
horizontal = 3;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#fourth leg to veretx 1
behavior waypoint_yoyo {
latitude = 36.4103;
longitude = -122.6392;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 145.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 145.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = heading;
horizontal = 145.0;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#third leg to veretx 1
behavior waypoint_yoyo {
latitude = 36.4103;
longitude = -122.6392;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 145.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 145.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = heading;
horizontal = 145.0;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#second leg to veretx 1
behavior waypoint_yoyo {
latitude = 36.4103;
longitude = -122.6392;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 145.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 145.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = heading;
horizontal = 145.0;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#first leg to veretx 1
behavior waypoint_yoyo {
latitude = 36.4103;
longitude = -122.6392;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 145.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 145.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = rudder;
horizontal = 3;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#fourth leg to veretx 3
behavior waypoint_yoyo {
latitude = 36.4868;
longitude = -122.7056;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 25.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 25.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = heading;
horizontal = 25.0;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#third leg to veretx 3
behavior waypoint_yoyo {
latitude = 36.4868;
longitude = -122.7056;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}


# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 25.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 25.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = heading;
horizontal = 25.0;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#second leg to veretx 3
behavior waypoint_yoyo {
latitude = 36.4868;
longitude = -122.7056;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}


# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 25.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 25.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = heading;
horizontal = 25.0;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#first leg to veretx 3
behavior waypoint_yoyo {
latitude = 36.4868;
longitude = -122.7056;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 25.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 25.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = rudder;
horizontal = 3;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#fourth leg to veretx 2
behavior waypoint_yoyo {
latitude = 36.4021;
longitude = -122.7056;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 265.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 265.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = heading;
horizontal = 265.0;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#third leg to veretx 2
behavior waypoint_yoyo {
latitude = 36.4021;
longitude = -122.7056;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 265.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 265.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = heading;
horizontal = 265.0;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#second leg to veretx 2
behavior waypoint_yoyo {
latitude = 36.4021;
longitude = -122.7056;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 265.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 265.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior
behavior ascend {
duration = 1200;
horizontalMode = heading;
horizontal = 265.0;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#First leg to veretx 2
behavior waypoint_yoyo {
latitude = 36.4021;
longitude = -122.7056;
captureRadius = 10;
duration = 2700;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 265.0;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 265.0;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 60;
abortOnTimeout = True;
}

# ascend behavior - use a rudder ascend to minimize overshoot
behavior ascend {
duration = 1200;
horizontalMode = rudder;
horizontal = 5;
pitch = 20;
speed = 1.50;
endDepth = 2;
}

#Initial leg to vertex 1
behavior waypoint_yoyo {
latitude = 36.4103;
longitude = -122.6392;
captureRadius = 10;
duration = 500;
speed = 1.50;
minDepth = 2.0;
maxDepth = 150;
maxCycles = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode = heading;
horizontal = 115;
pitch = -15;
speed = 1.50;
maxDepth = 5;
duration = 60;
}

# setpoint on surface to gather momentum
behavior setpoint {
duration = 30;
heading = 115;
speed = 1.50;
verticalMode = pitch;
pitch = 0;
}

# acquire gps fix
behavior getgps {
duration = 600;
minHits = 15;
abortOnTimeout = True;
}