successfully tested single wheel vel control
now vel control runs on units, added two separate sets of pid constants in vel control initialization
Merge branch 'navlib' of https://github.com/ut-ras/Rasware2013 into navlib