#optimal path #path minimization #least action principle #calculus of variations #trajectory optimization #geodesics