Armadillo 1.1.1: Added encoder functions in Drive class, like get distance and reset. Also added Velocity controller class, just a copy of the other PID controller so it doesn't work.