Closed cpezzato closed 1 year ago
2823f68c448a9e4594b918fa68c8c87597fe2dae addresses this, but the cost for collision avoidance should be based on contact forces as well, otherwise, we are not able to reach goals that are close to obstacles due to a 'repulsive force' effect.
The tuning of the mppi is a bit off, should be fixed for better performance