fixed PIDController infinite loop bug
Merge branch 'master' of https://github.com/team1511/Galoompha.git
Also fixed compile errors.