Komunikacja ATmega128 z MAX232 przez RS232 - jak to zrobić w C?

#include <avr/io.h> 

#define LED_0_ON DDRC |= _BV(PC0); PORTC |= _BV(PC0);
#define LED_0_OFF DDRC |= _BV(PC0); PORTC &=~ _BV(PC0);
#define LED_1_ON DDRC |= _BV(PC1); PORTC |= _BV(PC1);
#define LED_1_OFF DDRC |= _BV(PC1); PORTC &=~ _BV(PC1);
#define LED_2_ON DDRC |= _BV(PC2); PORTC |= _BV(PC2);
#define LED_2_OFF DDRC |= _BV(PC2); PORTC &=~ _BV(PC2);
#define LED_3_ON DDRC |= _BV(PC3); PORTC |= _BV(PC3);
#define LED_3_OFF DDRC |= _BV(PC3); PORTC &=~ _BV(PC3);

#define KEY_1 PINC |= _BV(PC4); PORTC &=~ _BV(PC4);

#define FOSC 8000000ul
#define BAUD 9600ul
#define MYUBRR FOSC/16/BAUD-1

void USART_Init( unsigned int ubrr)
{
	UBRRH = (unsigned char)(ubrr>>8);
	UBRRL = (unsigned char)ubrr;
	
	UCSRB = (1<<RXEN)|(1<<TXEN);
	
	UCSRC = (1<<URSEL)|(1<<USBS)|(3<<UCSZ0);
}

void USART_Transmit( unsigned char data )
{
	while ( !( UCSRA & (1<<UDRE)) );
	
	UDR = data;
}

int main( void ) 
{ 
	while(1)
	{
		USART_Init ( MYUBRR );
		
		if ( bit_is_clear(PINC,PC4) ) {
			LED_0_ON;
			USART_Transmit(4);
		} else {
			LED_0_OFF;
		}
		
		if ( bit_is_clear(PINC,PC5) ) {
			LED_2_ON;
			USART_Transmit(5);
		} else {
			LED_2_OFF;
		}
	}
	return(0); 
} 

#include <avr/io.h>

void USART_initialize(void);
void sendbyte(unsigned char data);
unsigned char readbyte (unsigned char *data);

#include <avr/io.h>
#include <avr/interrupt.h>
#include "USART.h"

void USART_initialize(void)
{
	UCSR0B = 0x18; // Set RXEN and TXEN
	UCSR0C = 0x06; // Set to 8 bit, NP, no stop bit
	UBRR0L = 0x47; // set Buad Rate
	UBRR0H = 0x00; // set Buad Rate

}

void sendbyte(unsigned char data)
{
	while(!(UCSR0A & 0x20));/* Wait until tx data register is empty */
	UDR0 = data; /* Place our byte into the Tx buffer */
}

unsigned char readbyte (unsigned char *data)
{
// non blocking routine..checks Receive complete bit, returns 0 if nothing available
// returns 1 if data available
	if (UCSR0A & 0x80) {
		*data = UDR0;
		return 1;
	} else {
	return 0;
	}
}

unsigned char znak;
USART_initialize();
while(1){
	if (readbyte(&znak))
	{
		sendbyte(znak);
	}
}