High frequency injection (HFI) close loop start and transit to SMO based FOC