Path Planner Module Test Code