functioning code. gui working, manual switch b/w pid and joystick control not yet written