Closed corradopav closed 8 years ago
Cost is currently calculated as the energy of the derivatives of joint speed. As soon as we have trapezoidal profile issue fixed we will be able to use (efficiently) the time as a cost to perform planning of minimum-time problems.
We have moved to minimum-time problems, so time is the cost.
Let's discuss more about how the cost is computed during a trajectory simulation