Added 1) Encoder Update and 2) Wheel velocity error states.
Current tuning works really well for the competition run Saturday 2013
Cleaned up some dead code, Moved a couple files into plots folder