Работа с UART (ATMega328)

#define F_CPU 8000000UL
#include <avr/io.h>
#include <util/delay.h>
#include <avr/interrupt.h>
 
#define FOSC 8000000UL // Clock Speed
#define BAUD 4800L
#define MYUBRR FOSC/16/BAUD-1
 
#define BUFFER_UART_SIZE 32
uint8_t Nbyte=0;
static uint8_t buff_uart[BUFFER_UART_SIZE]; 
 
 
void USORT_Init(unsigned int ubrr){
    UBRR0H = (unsigned char)(ubrr>>8);
    UBRR0L = (unsigned char)ubrr;
    /*Enable receiver and transmitter */
    UCSR0B = (1<<RXEN0)|(1<<TXEN0)|(1<<RXCIE0)|(1<<TXCIE0);
    /* Set frame format: 8data, 2stop*/
    UCSR0C = (1<<USBS0)|(3<<UCSZ00);
}
 
void USORT_Transmit( char data )
{
    /* Wait for empty transmit buffer */
    while ( !( UCSR0A & (1<<UDRE0)) );
    /* Put data into buffer, sends the data */
    UDR0 = data;
}
 
void USORT_Transim_String(char * data){
    unsigned char d;
    while(*data){
        d = *data++;
        USORT_Transmit(d);
    }
}
 
char USORT_Receive( void )
{
    /* Wait for data to be received */
    while ( !(UCSR0A & (1<<RXC0)) );
    /* Get and return received data from buffer */
    return UDR0;
}
 
void ClearBuffUart(void){
    for(int i=0;i<BUFFER_UART_SIZE;i++){
        buff_uart[i]=0;
    }   
}
 
ISR(USORT_RX_vect)
{
    unsigned char b;
    b = UDR0;
    buff_uart[Nbyte] = b;
    Nbyte++;
    if (b == (int16_t)0xFF){
        USORT_Transim_String(buff_uart);
        Nbyte = 0;
        ClearBuffUart();
    }   
    if (Nbyte>=BUFFER_UART_SIZE){
        USORT_Transim_String(BUFFER_UART_SIZE);
        Nbyte = 0;
        ClearBuffUart();
    } 
}
 
void main( void ){
    USORT_Init(MYUBRR);
    sei();
    while(1){
    }
}

#define F_CPU 8000000UL
#include <avr/io.h>
#include <util/delay.h>
#include <avr/interrupt.h>
 
#define FOSC 8000000UL // Clock Speed
#define BAUD 4800L
#define MYUBRR FOSC/16/BAUD-1
 
#define BUFFER_UART_SIZE 16
uint8_t Nbyte=0;
static uint8_t buff_uart[BUFFER_UART_SIZE]; 
uint8_t buffer_index = 0;
//Очистка буфера
void ClearBuffUart(void){
    for(int i=0;i<BUFFER_UART_SIZE;i++){
        buff_uart[i]=0;
    }   
    Nbyte = 0;
}
//Инициализация уарт
void USORT_Init(unsigned int ubrr){
    UBRR0H = (unsigned char)(ubrr>>8);
    UBRR0L = (unsigned char)ubrr;
    UCSR0B = (1<<RXEN0)|(1<<TXEN0)|(1<<RXCIE0)|(1<<TXCIE0);
    UCSR0C = (1<<USBS0)|(3<<UCSZ00);
}
//Передача масива
void USORT_Transmit(void)
{
    buffer_index=0;     
    UDR0 = buff_uart[0];    
    UCSR0B|=(1<<UDRIE0);
}
//Прерывание отправки данных
ISR (USORT_UDRE_vect){
    buffer_index++;
    if (buffer_index==Nbyte){
        UCSR0B &=~(1<<UDRIE0);
        ClearBuffUart();
    }       
    else{
        UDR0 = buff_uart[buffer_index];
    }   
}
//Прием данных
char USORT_Receive( void )
{
    while ( !(UCSR0A & (1<<RXC0)) );
    return UDR0;
}
//Прерывание по приему данных
ISR(USORT_RX_vect)
{
    unsigned char b;
    b = UDR0;
    buff_uart[Nbyte] = b;
    Nbyte++;
    if (b == (uint8_t)0xFF){
       USORT_Transmit();
    }
    if (Nbyte == BUFFER_UART_SIZE){
        USORT_Transmit();   
    }   
}
 
void main( void ){
    USORT_Init(MYUBRR);
    sei();
    while(1){
    }
}