Move to initial pose first