Submarine Control

New class added with thread to handle the basis of submarine control.
Needs testing