fixed major bug regarding NaNs (glitches) in the motor output. added proportional term gyroscope gating and tuned it properly.
Merge branch 'master' of github.com:jhauswald/koala