Drive Position Holding Added

Added all the code needed to get the drive train to hold one spot. Still
needs PID stuff though.