tugas robot bab 6 (Robotika) the result is not optimal