Tune-up fixes

Added a new library and added a bunch of fixes for after the robot tune
up