Added code to turn the robot in the direction of interpolation. Also added basic floor below robot.