merged the command sending and tethering. Don't know if it works on robot or not.
Merge branch 'master' of https://github.com/ErroneousPromulgation/Project2