Запись данных во Flash Sam7s256 Опции

[Spoofing]

Доброго времени суток.
Помогите решить такую проблему. Не могу разобраться как записать данные во флеш. Функционал - прием данных с USART запись в постоянную память, выдача по требованию. Все прекрасно работает с RAM - данные получаются и выдаются, но естественно сброс по питанию все обнуляет. С помошью SAM-BA залил прошивку, все работает из флеши и выполняется в RAM но как записывать пользовательские данные?
Судя по даташиту необходимо поместить данные в буфер-защелку, после чего запись команд в регистр EFC для операции со страницей №такой то. Где этот буфер определяется? по регистрам не нашел.

Второй вопрос как определить где закончится программа - с какого момента можно будет записать данные (флеш с 0х00100000 без ремапа начинается)
Не бейте сильно в электронике почти полный нуб) пока освоил инициализацию, прерывания и com

[aaarrr]

Не забудьте в MC_FMR записать корректные значения.

Код

    while(!( f_pMC->MC_FSR) & AT91C_MC_FRDY);

    if((f_pMC->MC_FSR & AT91C_MC_LOCKE) || (f_pMC->MC_FSR & AT91C_MC_PROGE))
    {
       return -1;
    }
    return 0;

Здесь потеряете биты ошибок в MC_FSR.

Код

    while(!( f_pMC->MC_FSR) & AT91C_MC_FRDY);

Здесь скобки стоят неправильно.