initial pose and set goal