Publishing in correct pose data--but still works