Switched to a PoseStamped message.  

Switched to using a PoseStamped message rather than Pose message.  Added parameter for the parent frame so the proper frame can be filled in the header of the PoseStamped message.