Safety fix (encoder values)+fixed sensor config

Have yet to make gyros work :P
Fixed gyro compensation + more clarity.
Merge pull request #31 from OlyCow/swerve-drive

Hotfix for swerve drive.