Code base for CPP Robosub Vehicle