Optimized-motion planning by Cherif Ahrikencheikh