3 Serbestlik Dereceli Manipülatör Kinematiği, Yörünge Planlama ve Simülasyon Optimizasyonu (ES)