Optimization of Debris Removal Path for TAMU Sweeper