Skip to content

Science/mind_the_drift.tl

  1
  2
  3
  4
  5
  6
  7
  8
  9
 10
 11
 12
 13
 14
 15
 16
 17
 18
 19
 20
 21
 22
 23
 24
 25
 26
 27
 28
 29
 30
 31
 32
 33
 34
 35
 36
 37
 38
 39
 40
 41
 42
 43
 44
 45
 46
 47
 48
 49
 50
 51
 52
 53
 54
 55
 56
 57
 58
 59
 60
 61
 62
 63
 64
 65
 66
 67
 68
 69
 70
 71
 72
 73
 74
 75
 76
 77
 78
 79
 80
 81
 82
 83
 84
 85
 86
 87
 88
 89
 90
 91
 92
 93
 94
 95
 96
 97
 98
 99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
#   Copyright (c) 2024 MBARI
#   MBARI Proprietary Information. Confidential. All Rights Reserved
#   Unauthorized copying or distribution of this file via any medium is strictly
#   prohibited.
#
#   WARNING - This file contains information whose export is restricted by the
#   Export Administration Act of 1979 (Title 50, U.S.C., App. 2401 et seq.), as
#   amended. Violations of these export laws are subject to severe civil and/or
#   criminal penalties.

mission {
  """
  This mission drifts level at a depth while running the backseat and
  sending acomms data. Originally it was written for the Big Business of
  getting ayeris images transferred over the acomms link. The Drift: You
  start sinking, better grab an oar and row. And please take a path that
  you know You start thinking, making up the images as you go, as you go.
  """

  arguments {
    MissionTimeout = 120 minute
      """
      Maximum duration of mission
      """

    NeedCommsTime = 60 minute
      """
      How often to surface for commumications
      """

    AcousticModemCommsInterval = 5 minute
      """
      How often to trigger acoustic modem communications
      """

    Depth = 35 meter
      """
      How deep to drift.
      """

    DepthDeadband = 1 meter
      """
      How much vertical drift from the specified depth is allowed durnig the
      mission.
      """

    ApproachSpeed = 1 meter_per_second
      """
      Enables vehicle thruster at the commanded speed to reach target depth
      (set to 0 m/s to drift).
      """

    ApproachDepthTimeout = 20 minute
      """
      Maximum wait time for the vehicle to reach the targeted depth.
      """

    ApproachPitchLimit = 20 degree
      """
      Max vehicle pitch (+/-) when decending from the surface.
      """

    MinAltitude = 5 meter

    MaxDepth = 52 meter

    MinOffshore = 2 kilometer

    CheckDepths = 1 bool

    PowerBackseat = 1 bool
      """
      Set to false to disable backseat
      """
  }

  timeout duration=MissionTimeout

  insert Insert/Science.tl

  insert id="NeedComms" Insert/NeedComms.tl

  assign in sequence NeedComms:DiveInterval = NeedCommsTime

  insert Insert/StandardEnvelopes.tl

  assign in sequence StandardEnvelopes:MinAltitude = MinAltitude

  assign in sequence StandardEnvelopes:MaxDepth = MaxDepth

  assign in sequence StandardEnvelopes:MinOffshore = MinOffshore

  insert id="AcousticComms" Insert/AcousticModemComms.tl {
    redefineArg CommsInterval = AcousticModemCommsInterval
  }

  aggregate CheckTargetDepths {
    run in sequence

    break if ( not ( CheckDepths ) )

    aggregate CheckDepth {
      run in sequence

      break if ( not ( Depth > MaxDepth ) )

      syslog important "Aborting mission. Target depth exceeds the mission's MaxDepth setting (review mission parameters)."

      behavior Guidance:Execute {
        run in sequence

        set command = "stop"
      }
    }

    assign in sequence CheckDepths = 0 bool
  }

  call id="StartingMission" refId="NeedComms"

  insert Insert/BackseatDriver.tl

  assign in sequence BackseatDriver:EnableBackseat = PowerBackseat

  insert Insert/PowerOnly.tl

  aggregate TheDrift {
    run in sequence

    break if ( isNaN ( Depth ) )

    assign in parallel Control:VerticalControl.kpPitchMass = 0.005 ratio

    assign in parallel Control:VerticalControl.kiPitchMass = 0.00075 reciprocal_second

    assign in parallel Control:VerticalControl.kdPitchMass = 0 second

    assign in parallel Control:VerticalControl.depthDeadband = DepthDeadband

    # DO NOT REMOVE the syslog entry below. The MissionManager seems to ignore the value of ApproachSpeed and does not evaluate the SetSpeed statement properly. Adding the syslog call somehow fixes it.

    syslog info "Going to target depth. Speed set to "
         + ApproachSpeed~meter_per_second

    aggregate GoToTargetDepth {
      run in sequence

      assign in parallel Control:VerticalControl.pitchLimit = ApproachPitchLimit

      aggregate ActuatorHold {
        """
        Hold the positions of the mass, VBS, and rudder while going
        to the target depth with the thruster on.
        """

        run while ( ApproachSpeed > 0 meter_per_second )

        behavior Guidance:Point {
          run in parallel

          set rudderAngle = 13 degree
        }

        behavior Guidance:Buoyancy {
          run in parallel

          set position = Control:VerticalControl.buoyancyNeutral
        }

        behavior Guidance:Pitch {
          run in parallel

          set massPosition = Control:VerticalControl.massDefault
        }
      }

      aggregate ApproachDepth {
        run in sequence

        syslog "Moving to " + Depth~meter

        behavior Guidance:SetSpeed {
          run in parallel

          set speed = ApproachSpeed
        }

        behavior Guidance:Pitch {
          run in sequence

          timeout duration=ApproachDepthTimeout {
            syslog important "Timed out trying to reach the target depth. Stopping mission at current depth of "
                 + Universal:depth~meter

            behavior Guidance:Execute {
              run in sequence

              set command = "stop"
            }
          }

          set depth = Depth
        }
      }
    }

    aggregate DriftAtDepth {
      """
      Drift at 0 speed at target depth.
      """

      run in sequence

      assign in parallel Control:VerticalControl.depthDeadband = DepthDeadband

      behavior Guidance:SetSpeed {
        run in parallel

        set speed = 0 meter_per_second
      }

      behavior Guidance:Pitch {
        run in parallel

        set depth = Depth
        set elevatorAngle = 0 degree
        set pitch = 0 degree
      }

      syslog info "Holding at depth. Depth = " + Universal:depth~meter

      behavior Guidance:Wait {
        run in sequence

        set duration = MissionTimeout
      }
    }
  }
}