Latest commit 19ac3a5 Jan 15, 2015 @marcusbarbu marcusbarbu -Fixed PID control 
-time to tune
-TODO clean up code, maybe refactor?