Professional Documents
Culture Documents
Michael L. Graves II
Engineer, Vehicle Control Technologies, Inc.
Dr. Douglas E. Humphreys
President, Vehicle Control Technologies, Inc.
I. INTRODUCTION
Authorized licensed use limited to: Central Mechanical Engineering Research Institute. Downloaded on October 21,2022 at 07:48:44 UTC from IEEE Xplore. Restrictions apply.
produced by conventional lifting control surfaces. It was The vehicle is open-loop unstable in pitch for span
found that the drag-brake was ineffective except at angles lengths over intermediate ranges. Fin span has a significant
creating unacceptable levels of drag. For this reason, effect on the two real modes at -1 and -9 RAD/SEC. As the
conventional fins were used. span increases, these two roots initially couple into an
oscillatory pair, but then return to the real axis. For the
lateral plane, increasing the control fin span increases the
high frequency pole (the primary driver for the actuator
requirements) from -32 to -65 RAD/SEC requiring a trade off
between open-loop stability (large fins) and actuator
Imaginary Axis (rad/sec)
Authorized licensed use limited to: Central Mechanical Engineering Research Institute. Downloaded on October 21,2022 at 07:48:44 UTC from IEEE Xplore. Restrictions apply.
the crossover frequency is 0.413 RAD/SEC.
Magnitude (dB)
Imaginary Lat (rad/sec)
Phase (deg)
Real Lat (rad/sec)
III. AUTOPILOT DESIGN Fig. 8 is the bode diagram of the roll loop. The gain
margin is 16 dB, the phase margin is 66 degrees, and the
The design of the autopilot for the vehicle is now crossover frequency is 0.158 RAD/SEC.
discussed. The primary functions of the autopilot are depth
keeping and heading control. The autopilot will run at 10
Hz on a small form-factor computer board. Off-the-shelf
actuators are utilized with a bandwidth of 4 Hz. An attitude
Magnitude (dB)
The major blocks of the autopilot are the depth and pitch
controllers for the longitudinal plane, and the roll and
heading controllers for the lateral plane. There are also a
speed controller and fin mixing blocks.
Using VCT Tools™, the hydrodynamic configuration of
Frequency (RAD/SEC)
the vehicle was used to design the control system gains.
The next three figures depict the bode diagrams for the Fig. 8. Bode plot of the roll loop.
lateral plane.
1). Lateral Plane Bode Diagrams 2). Longitudinal Plane Bode Diagrams
Fig. 6 shows the bode diagram for the rudder loop. The The next three bode diagrams are for the longitudinal
gain margin is 12 dB, the phase margin is 89.5 degrees, and plane. Fig. 9 is for the stern plane loop. The gain margin is
the crossover frequency is 1.07 RAD/SEC. 11 dB, the phase margin is 61 degrees, and the crossover
frequency is 2.11 RAD/SEC.
Magnitude (dB)
Magnitude (dB)
Phase (deg)
Phase (deg)
Frequency (RAD/SEC)
Frequency (RAD/SEC)
Fig. 6. Bode plot of the rudder loop.
Fig. 9. Bode plot of the stern plane loop.
Fig. 7 is the bode diagram for the heading loop. The
gain margin is 17 dB, the phase margin is 59 degrees, and
Authorized licensed use limited to: Central Mechanical Engineering Research Institute. Downloaded on October 21,2022 at 07:48:44 UTC from IEEE Xplore. Restrictions apply.
Fig. 10 is for the pitch loop. The gain margin is 10 dB, 4). Longitudinal Plane Step Response
the phase margin is 55 degrees, and the crossover frequency Fig. 13 is a commanded step response for depth. The
is 1.52 RAD/SEC. vehicle is commanded to a depth excursion of 10 FT in black.
The depth response of the vehicle is shown in red.
Magnitude (dB)
Depth (ft)
Phase (deg)
Frequency (RAD/SEC)
Fig. 10. Bode plot of the pitch loop.
Time (sec)
Fig.11 is for the depth-pitch loop. The gain margin is 17 Fig. 13. Depth step response.
dB, the phase margin is 60 degrees, and the crossover
frequency is 0.342 RAD/SEC.
Both the heading (in black) and roll (in red) are plotted
in Fig. 15. Note that as the vehicle completes its clockwise
heading transitions, the vehicle rolls into the turn about 9
DEG.
Fig. 16 details the pitch during the simulation. There is
Frequency (RAD/SEC)
minimal pitch disturbance as the vehicle transitions from
Fig. 11. Bode plot of the depth-pitch loop. the heading commands. The time history of depth in Fig. 17
also reflects steadiness in the longitudinal plane during the
3). Lateral Plane Step Response turns.
Fig.12 is a commanded step response of the heading of
10 DEG, shown in blue. The vehicle’s heading is in red, and
its corresponding roll is in black.
Heading and Roll (deg)
Time (sec) Y
Fig. 12. Heading step response. Fig. 14. Simulated race track pattern
Authorized licensed use limited to: Central Mechanical Engineering Research Institute. Downloaded on October 21,2022 at 07:48:44 UTC from IEEE Xplore. Restrictions apply.
Heading and roll (deg)
The stern plane is shown in Fig. 18. Both the rudder (in IV. CONCLUSIONS
black) and aileron (in red) are plotted in Fig. 19. Only -0.3
DEG of rudder is required to turn the vehicle. A value of The hydrodynamic and autopilot design were presented
-0.55 DEG was used by the aileron to control the roll in the for an AUV. The challenge of fine tuning the open-loop
turn. dynamics of the vehicle was shown to overcome a large
frequency peak in the lateral plane. Gains were succesfully
designed to give the vehicle at least an 8 dB gain margin and
a 45 DEG phase margin. Finally, a non-linear simulation of
the vehicle proved its design.
Time (sec)
Fig. 17. Vehicle depth.
Authorized licensed use limited to: Central Mechanical Engineering Research Institute. Downloaded on October 21,2022 at 07:48:44 UTC from IEEE Xplore. Restrictions apply.