Added rough version of simple control mode

Also abstracted bluetooth out a tiny bit.