Fix setColor
Values are on the SmartDashboard and can be set from there
Merge branch 'develop' of github.com:2729StormRobotics/Storm2014 into develop