Added balancing and joystick control
Merge pull request #2 from qj358927/master

Added balancing and joystick control