Got it to move in all directions with delays, but having problems with it reseting once i put robot on ground.