added a new function DriveRobot_new

This is a new function that enhanced the algorithm of the older one in
hopes that it will be used next year.