Алгоритм программирования FLASH памяти Atmega48, по SPI Опции

[algidim]

Здравствуйте ! В устройстве 2 микроконтроллера LPC1768 второй вспомогательный atmega48, хочется сделать так чтобы при начальной заливке или обновлении прошивки LPC1768 автоматически программировал atmega48… Т.е нужно написать программатор для atmega 48. Atmega48 подключена по SPI + вывод reset
Не могу разобраться с алгоритмом программирования FLASH памяти – читать память получается а вот записывать не очень )) Читаю по командам $28 (старший байт) $27 (младший байт).
Записывать я так понял там нужно по командам $40 и $48 в страницу памяти а потом по команде $4C переписывать во FLASH память.

Смотрел исподники avr910 там пишется байт по команде $40 и $48 а потом сразу же проверяется его запись, т.е читается по команде $28 и $27 . У меня при чтении читается байт, который там записан ( проверка реальным программатором ) а вот команды $40 и $48 получается проходят в холостую ))
Может кто подскажет алгоритм программирования Flash памяти ? или поделится исходником, где это понятно…