PathPlanning seems to be working.