################################################################################
#
# PURPOSE: Simulate wall following.  Check Rock's family of ic sim runs.
#          
# AUTHOR:  rsm
# DATE:    9 Oct 2013
# NOTE:    Sequential behaviors are bottom-up.  Priorities are top-down.
# MODS:
#
################################################################################
# 
behavior missionTimer
{
  timeOut = 3500;
}
#
# Depth Envelope
#
behavior depthEnvelope
{
  minDepth      = 0;         #Meters
  maxDepth      = 250;        #Meters
  abortDepth    = 245;        #Meters
  minAltitude   = 20;        #Meters
  abortAltitude = 15;        #Meters
  deltaDepthRestart =5;      #Meters
  minObstacleRange = 20.;    #Meters
}
# pitchLimitAltitude = 9.;   #Meters-below which the commanded pitch is clipped.
# maxLowerPitch = 10.;       #Degrees, positive.
#
#behavior lowAltitudeFollowing
#{
#  endTime = 3600;
#}
# behavior ascend 
# {
#   duration         = 200;       #Seconds
#   horizontalMode   = heading;  #Mode
#   horizontal       = 90;       #Degrees; 
#   pitch            = 30;       #Degrees
#   speed            = 1.5;      #Meters/sec
#   endDepth         = 0;	       #Meters
# }
 behavior waypoint_wall
{
    latitude    =   36.68388;
    longitude   = -121.99276;
    duration     = 600; 
    speed        = 1.5;
    initialDepth = 60;
    finalDepth   = 60;
    speed        = 1.5;
    starboardMaxCrossTrackError = 300;
    maxCrossTrackError = 300;    #Meters; Maximum cross-track displacement
    standOff     = 50;          #Meters; Stand off from the wall
    sonarTimeOut = 2;           #Seconds;
    useWallEstimator = True;
    wallFeedForward  = False;
}
 behavior waypoint_wall
{
    latitude    =   36.68388;
    longitude   = -121.99276;
    duration     = 600; 
    speed        = 1.5;
    initialDepth = 50;
    finalDepth   = 50;
    speed        = 1.5;
    starboardMaxCrossTrackError = 300;
    maxCrossTrackError = 300;    #Meters; Maximum cross-track displacement
    standOff     = 50;          #Meters; Stand off from the wall
    sonarTimeOut = 2;           #Seconds;
    useWallEstimator = True;
    wallFeedForward  = False;
}
 behavior waypoint_wall
{
    latitude    =   36.68388;
    longitude   = -121.99276;
    duration     = 600; 
    speed        = 1.5;
    initialDepth = 40;
    finalDepth   = 40;
    speed        = 1.5;
    starboardMaxCrossTrackError = 300;
    maxCrossTrackError = 300;    #Meters; Maximum cross-track displacement
    standOff     = 50;          #Meters; Stand off from the wall
    sonarTimeOut = 2;           #Seconds;
    useWallEstimator = True;
    wallFeedForward  = False;
}
 behavior waypoint_wall
{
    latitude    =   36.68388;
    longitude   = -121.99276;
    duration     = 600; 
    speed        = 1.5;
    initialDepth = 30;
    finalDepth   = 30;
    speed        = 1.5;
    starboardMaxCrossTrackError = 300;
    maxCrossTrackError = 300;    #Meters; Maximum cross-track displacement
    standOff     = 50;          #Meters; Stand off from the wall
    sonarTimeOut = 2;           #Seconds;
    useWallEstimator = True;
    wallFeedForward  = False;
}
#behavior lowAltitudeFollowingOff
#{
#    duration = 2;	
#}
 behavior waypoint_wall
{
    latitude    =   36.68088;
    longitude   = -121.99276;
    duration     = 300; 
    speed        = 1.5;
    initialDepth = 30;
    finalDepth   = 30;
    speed        = 1.5;
    starboardMaxCrossTrackError = 300;
    maxCrossTrackError = 300;    #Meters; Maximum cross-track displacement
    standOff     = 50;          #Meters; Stand off from the wall
    sonarTimeOut = 2;           #Seconds;
    useWallEstimator = True;
    wallFeedForward  = False;
}
 behavior waypoint_wall
{
    latitude    =   36.68088;
    longitude   = -121.99276;
    duration     = 300; 
    speed        = 1.5;
    initialDepth = 20;
    finalDepth   = 20;
    speed        = 1.5;
    starboardMaxCrossTrackError = 300;
    maxCrossTrackError = 300;    #Meters; Maximum cross-track displacement
    standOff     = 50;          #Meters; Stand off from the wall
    sonarTimeOut = 2;           #Seconds;
    useWallEstimator = True;
    wallFeedForward  = False;
}
#
#Started here:
#Feb 2016 Triangle Island start N=4060100, E=590100m.
#latitude    =   36.68167;            //Decimal Degrees
#longitude   = -121.99162;            //Decimal Degrees. Minus for West Long.
#
# Sequential behaviors begin at the bottom.
#
