jpcpontes

I also have a similar issue with a car-like robot around obstacles. The path generated by TEB gets very messy, and the control frequency drops drastically.  My parameter config...