Mark2 robosub Software for the embedded platform