Simple movement logic added. Stops in front of obstacle, slowing down.