Стирание внешней флэш-памяти (микроконтроллер MCF51EM256)

Я работаю с микроконтроллером Freescale MCF51EM256, и у меня возникают проблемы со стиранием внешней флэш-памяти (0x20000 - 0x2FFFF).

Это моя основная программа:

void main(void) {
  EnableInterrupts;

  FlashInit();

  DisableInterrupts;
  EraseFlash(0x020000);
  EraseFlash(0x020800);
  EraseFlash(0x020C00);
  EnableInterrupts;

  for(;;) {
    __RESET_WATCHDOG(); /* feeds the dog */
    SetLED(2, 2);       // Toggle led if the program is running
  } /* loop forever */
  /* please make sure that you never leave main */
}

Где "СтеретьFlash()":

void EraseFlash(long addr){
    // The flash sector to erase is always 1 kB

    long eraseValue = 0xFFFFFFFF;
    Flash_Cmd((unsigned long)addr, 1, &eraseValue, 0x40);
}

И "Flash_Cmd()":

#define FLASH_MASS_ERASE_CMD  0x41
#define FLASH_ERASE_CMD       0x40
#define FLASH_PROGRAM_CMD     0x20
#define FLASH_BURST_CMD       0x25

UINT8 /*far*/ 
Flash_Cmd(UINT32 FlashAddress, 
      UINT16 FlashDataCounter, 
      UINT32 *pFlashDataPtr, 
      UINT8 FlashCommand)
{
  /* Check to see if FACCERR or PVIOL is set */
  if (FSTAT &0x30)  
  {         
      /* Clear Flags if set*/
      FSTAT = 0x30;  
  }

  if (FlashDataCounter)
  {
    do
    {
        /* Wait for the Last Busrt Command to complete */
        while(!(FSTAT&FSTAT_FCBEF_MASK)){};/*wait until termination*/

        /* Write Data into Flash*/
        (*((volatile unsigned long *)(FlashAddress))) = *pFlashDataPtr;
        FlashAddress += 4;
        pFlashDataPtr++;

        /* Write Command */
        FCMD = FlashCommand;

        /* Put FCBEF at 1 */
        FSTAT = FSTAT_FCBEF_MASK;

        asm (NOP);
        asm (NOP);
        asm (NOP);

         /* Check if Flash Access Error or Protection Violation Error are Set */
        if (FSTAT&0x30)
        {     
          /* If so, finish the function returning 1 to indicate error */
          return (1);
        }

    }while (--FlashDataCounter);
  }
  /* wait for the last command to complete */
  while ((FSTAT&FSTAT_FCCF_MASK)==0){};/*wait until termination*/

  /* Return zero to indicate that the function executed OK */
  return (0);
}

Мой main никогда не достигает цикла for(;;), потому что он заблокирован третьим вызовом EraseFlash().

Если ставлю только два или меньше звонков, то работает. Пример:

void main(void) {
  EnableInterrupts;

  Platform_GPIO_Init();
  FlashInit();

  DisableInterrupts;
  EraseFlash(0x020000);
  EraseFlash(0x020800);
  EnableInterrupts;

  for(;;) {
    __RESET_WATCHDOG(); /* feeds the dog */
    SetLED(2, 2);       // Toggle led if the program is running
  } /* loop forever */
  /* please make sure that you never leave main */
}

Может кто-нибудь сказать мне, что я делаю неправильно? Я также пробовал с другим адресом флэш-памяти и без отключения прерываний, и то же самое.

Редактировать: оба вызова возвращают 0, что означает, что функция выполнена нормально.

Спасибо вам всем!