Speed and Depth Package for Triton Autopilot