Armadillo 1.2.0: Finished velocity pid controller, renamed distance pid into position