Add initial pose message publisher