Added path plan graph