Add the possibility to set the SwingFootPlanner position and orientation tolerances as configuration parameters

Add the possibility to set the SwingFootPlanner position and orientation tolerances as configuration parameters #2740