Optimization of Grading Path Planning for an Autonomous Construction Machine