Closed henningkayser closed 2 years ago
I can confirm that the oscillations caused by servo disappeared :+1: The correct initial state is added here: #40 .
I also noticed that the temporary moveit branch with hybrid planning + pilz didn't contain some (namespace) fixes of the open PR, so I added it to another temprorary branch. Feel free to change this...
This should make execution more robust by increasing the waypoint distance threshold and by adding a position-based check as well (prevents possible joint jumps). The implementation is really really basic, though, we should consider implementing something more robust in the future.