Avoir un echo des commandes envoyer au ATMEGA

Bonjours a tous.
Dans le cadre de mon projet de fin d'année de DUT, je dois réaliser la mise a jour d'un systeme grâce à la fonction de Bootloader du µcontroleur ATMEGA 2650.
Dans un premier temps j'ai réussi a entrée dans la section de BOOT, mais mon soucie c'est que je voudrais avoir un echo des commande que j'envoie à mon ATMEGA.
VOici mon programme main :

void boot_test(void) BOOTLOADER_SECTION;

void boot_test(void)
{
initIO();
initInterruptionExterne();
initADC();

SER_init();
VAR_init();

SER_envoie(SER_IHM,0xAF,0,NULL);

while(1)
{
PORTJ &= ~(1<<LED1);
PORTJ &= ~(1<<LED2);
PORTJ &= ~(1<<LED3);
PORTJ &= ~(1<<LED4);
SER_envoie(SER_IHM,0xBF,0,NULL);
}


}

pour le moment le programme de BOOT allume 4LEDS en permanance, mais ce que je voudrais c'est un echo des commandes que j'envoie à l'écran : ci-dessus de la commande SER_envoie(SER_IHM,0xAF,0,NULL);

Je vous remercie d'avance.