Making sure the goal state is reachable/clearing it when planning with MoveIt!
When planning using MoveIt!, it sometimes happens that a intended goal state cannot be reached because it is close to a collision and noise in sensor data (e.g. octomap) leads to collision checks failing, meaning planning is aborted. Are there already mechanisms in place for avoiding this issue, for example just clearing the goal state?