adding service to set pose

This is where we added a service to set pose. Nice to have. Let me know what you think and/or if something is not up to snuff.