Added function to update both pose and orientation. Consider making pose private.