Salah satu penelitian yang dilakukan oleh Bhattacharya pada tahun 2007 adalah masalah kontrol optimal pada pergerakan robot untuk menghindari hambatan dengan fungsi tujuan meminimumkan energi dengan kecepatan yang konstan. Pada penelitian ini akan dimodifikasi fungsi tujuan yakni meminimalkan lintasan dan energi dengan kecepatan berubah-ubah terhadap waktu. Solusi dari permasalahan ini diselesaikan secara numerik dengan menggunakan TOMLAB/PROPT. Perbandingan solusi dari model sebelum modifikasi dengan model setelah dimodifikasi menunjukkan bahwa jumlah energi yang digunakan berkurang disebabkan adanya pengaturan kecepatan dan percepatan pada pergerakan robot, sehingga diberikan nilai penalti kontrol pada variabel kontrol lintasan γ=0,05 dan variabel kontrol energi α=0,3, dimana nilai penalti ini memberikan solusi yang paling baik pada permasalahan ini dan sesuai dengan fungsi tujuan yang dimodifikasi. Kata kunci: model Obstacle Avoidance, kontrol optimal, TOMLAB/PROPT, nilai penalti