Added function to drive straight a given distance
Merge branch 'movement_straight' of https://github.com/Vandborg/SW505E14-Software into movement_straight
Added straight start movement utility
added comments in header for util drive straight.