###########################  END OF NORTHBOUND LEG 1 ##################################



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

#Leg to waypoint LOCO1
#N36 47.38 W121 49.21
#maximum depth 26m
behavior waypoint_yoyo {
latitude     = 36.7897;
longitude     = -121.8202;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 22;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode   = heading;
horizontal      = 25;
pitch        = -15;
speed        = 1.5;
maxDepth     = 5;
minAltitude  = 9;
duration     = 60;
}

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO2
#N36 47.00 W121 49.33
#maximum depth 27m
behavior waypoint_yoyo {
latitude     = 36.7833;
longitude     = -121.8222;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 23;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

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

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO3
#N36 46.57 W121 49.49
#maximum depth 27m
behavior waypoint_yoyo {
latitude     = 36.7762;
longitude     = -121.8248;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 23;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

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

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO4
#N36 46.12 W121 49.64
#maximum depth 22m
behavior waypoint_yoyo {
latitude     = 36.7687;
longitude     = -121.8273;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 20;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

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

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO5
#N36 45.66 W121 49.82
#maximum depth 20m
behavior waypoint_yoyo {
latitude     = 36.7610;
longitude     = -121.8303;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 20;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

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

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO6
#N36 45.14 W121 49.96
#maximum depth 20m
behavior waypoint_yoyo {
latitude     = 36.7523;
longitude     = -121.8327;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 20;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

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

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO7
#N36 44.59 W121 50.03
#maximum depth 20m
behavior waypoint_yoyo {
latitude     = 36.7432;
longitude     = -121.8338;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 20;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

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

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO8
#N36 43.97 W121 50.05
#maximum depth 20m
behavior waypoint_yoyo {
latitude     = 36.7328;
longitude     = -121.8342;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 20;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode   = heading;
horizontal      = 2;
pitch        = -15;
speed        = 1.5;
maxDepth     = 5;
minAltitude  = 9;
duration     = 60;
}

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO9
#N36 43.35 W121 50.05
#maximum depth 25m
behavior waypoint_yoyo {
latitude     = 36.7225;
longitude     = -121.8342;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 20;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode   = heading;
horizontal      = 0;
pitch        = -15;
speed        = 1.5;
maxDepth     = 5;
minAltitude  = 9;
duration     = 60;
}

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO10
#N36 42.69 W121 50.09
#maximum depth 27m
behavior waypoint_yoyo {
latitude     = 36.7115;
longitude     = -121.8348;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 23;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode   = heading;
horizontal      = 2;
pitch        = -15;
speed        = 1.5;
maxDepth     = 5;
minAltitude  = 9;
duration     = 60;
}

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO11
#N36 41.98 W121 50.17
#maximum depth 37m
behavior waypoint_yoyo {
latitude     = 36.6997;
longitude     = -121.8362;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 33;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

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

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO12
#N36 41.32 W121 50.29
#maximum depth 44m
behavior waypoint_yoyo {
latitude     = 36.6887;
longitude     = -121.8382;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 40;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode   = heading;
horizontal      = 10;
pitch        = -15;
speed        = 1.5;
maxDepth     = 5;
minAltitude  = 9;
duration     = 60;
}

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO13
#N36 40.67 W121 50.46
#maximum depth 40m
behavior waypoint_yoyo {
latitude     = 36.6778;
longitude     = -121.8410;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 36;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode   = heading;
horizontal      = 10;
pitch        = -15;
speed        = 1.5;
maxDepth     = 5;
minAltitude  = 9;
duration     = 60;
}

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}


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

#Leg to waypoint LOCO14
#N36 40.14 W121 50.65
#maximum depth 37m
behavior waypoint_yoyo {
latitude     = 36.6690;
longitude     = -121.8442;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 33;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode   = heading;
horizontal      = 10;
pitch        = -15;
speed        = 1.5;
maxDepth     = 5;
minAltitude  = 9;
duration     = 60;
}

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}



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

#Leg to waypoint LOCO15
#N36 39.71 W121 50.85
#maximum depth 36m
behavior waypoint_yoyo {
latitude     = 36.6618;
longitude     = -121.8475;
captureRadius = 10;
duration     = 1800;
speed        = MISSION_SPEED;
minDepth       = 2.0;
maxDepth       = 32;
minAltitude    = YOYO_MIN_ALTITUDE;
maxCycles      = 2000;
}

# Descend behavior to 5 meters
behavior descend {
horizontalMode   = heading;
horizontal      = 20;
pitch        = -15;
speed        = 1.5;
maxDepth     = 5;
minAltitude  = 9;
duration     = 60;
}

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

behavior getgps {
duration = 900;
minHits = 15;
abortOnTimeout = True;
}