cleaned up code and fixed bump algorithm
Merge branch 'develop' of https://github.com/erhs-robotics/LibX into develop