################################################################################
#
# PURPOSE: Temperature following behavior to track tide generated internal wave
# AUTHOR:  Zhang, Hoover
# DATE:    2007MAR16
# NOTE:    Planned as backup second mission, short run, toward beach to test behavior.
#		This will be used if temp bands are not clear yet.
#		Sequential behavoirs are bottom-up.  Priorities are top-down.
#		Start this mission from Midway waypoint
# MODS:
#
################################################################################


#
# Inshore waypoint: 	
# Latitude:  	   36º 41.70 min (36.6950º)
# Longitude:	 -121º 53.40 min (-121.8900º)
# Depth:	45 fathoms or 80 meters
#
# Offshore waypoint:			
# Latitude:  	   36º 42.10 min (36.7017º)
# Longitude:	 -121º 56.10 min (-121.9350º)
# Depth:        55 fathoms or 100 meters
#
# Distance between 2 waypoints: 4.082 km
# If vertical speed of AUV while doing yoyo is 1.3m/s, 
# it will take AUV 52min20s to go from one point to the other
#
#
# Midway point: 	
# Latitude:  	   36º 41.90 min (36.6984º)
# Longitude:	 -121º 54.75 min (-121.9125º)
#
# Distance between Inshore and Midway is 2041 meters
# If horizontal speed of AUV while doing yoyo is 1.3m/s, 
# it will take AUV 1570s or 26min10s to go from Inshore to Midway
#
#
#



# Mission timer
# Total time in subroutines is 3690
# Time to travel distance is 1570
# Estimated time for total mission is 1840 or 30min40sec
# Max time set at 2200
# "Wrong way Charlie" AUV is only halfway to the beach
behavior missionTimer {
timeOut = 2200;
}

# Maximum depth and Abort Depth
behavior depthEnvelope {
 minDepth = 0;
 maxDepth = 60;
 abortDepth = 70;
 abortAltitude = 2.5;
}

# 300 secs or 30 GPS hits to continue
behavior getgps {
duration = 300;
minHits = 30;
abortOnTimeout = True;
}

# Surface, 20 upangle, for 20 minutes
# estimate 120sec from max depth to surface
behavior ascend {
duration = 1200;
horizontalMode = rudder;
horizontal = 10;
pitch = 20;
speed = 1.5;
endDepth = 2;
}

# 30 minutes to Inshore 
behavior waypointtemp_yoyo {
latitude = 36.6950;
longitude = -121.8900;
captureRadius = 10;
duration = 1800;
speed = 1.5;
minDepth = 2.5;
maxDepth = 40;
minAltitude = 10.0;
maxCycles = 1000000;
}

# Dive, 15 degre down angle to 5 meter depth for 60 sec
behavior descend {
horizontalMode = heading;
horizontal = 101;
pitch = -15;
speed = 1.5;
maxDepth = 5;
minAltitude = 9;
duration = 60;
}


# 30 seconds to gain speed at heading 101
behavior setpoint {
duration = 30;
heading = 101;
speed = 1.5;
verticalMode = pitch;
pitch = 0;
}

# 300 seconds or 30 GPS hits
behavior getgps {
duration = 300;
minHits = 30;
abortOnTimeout = True;
}