OMPL Solver Initializer: fix margin used in collision checks
OMPL Solver Initializer: fix margin used in collision checks

openhumanoids/exotica,openhumanoids/exotica,openhumanoids/exotica,openhumanoids/exotica