A conservative biomimetic control architecture for autonomous underwater robots