Changed default margin back to 2.0 as goal state initialisation will take care of this now
Changed default margin back to 2.0 as goal state initialisation will take care of this now

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