new srv and changed Object6DPose
Merge pull request #593 from h-kamada/change-6dpose

new srv and changed Object6DPose