added drive straight function, added shells for turn in place functions