Movement of robot and caring for obstructions(not working yet though)