adde debug pose
Added MoveGroupGetPlanningSceneService which allows accessing the planning scene objects by service call