Optimized path planner, serial output normalized