Diving supervisor for AUVs.
Diving is responsible to make sure the vehicle is capable of submerging by demanding an increase in motor speed.
State machine states.
Idle doing nothing.
Checking if vehicle can submerge.
Vehicle is submerged.
Forcing vehicle to submerge using speed.