add set initial pose service