Jak skonfigurować SPI dla ATMega32 i pamięci 25C040?

 SPCR = 0x72; //setup SPI
 SPSR = 0x00; //setup SPI

void SPI_WyslijZnak(char data)
{
PORTB&=~0b00010000;               //PortB.4 jako CS = poziom niski
SPDR=data;
while (!(SPSR & (1<<SPIF)) );
SPSR &=~SPIF;                          //kasowanie znacznika końca transmisji
PORTB|=0b00010000;                //PortB.4 jako CS poziom wysoki
}

void SPI_WyslijDane(char adres, char data)
{
SPSR &=~SPIF;
SPI_WyslijZnak(0b00000010);   //instrukcja zapisu danej do pamięci
SPI_WyslijZnak(adres);            //przesłanie adresu
SPI_WyslijZnak(data);             //przesłanie danej
}

char SPI_OdbierzData(char adres)
{
SPSR &=~SPIF;                          //kasowanie znacznika końca transmisji
PORTB&=~0b00010000;             //CS=poziom niski
SPDR=0b00000011;                  //instrukcja odbioru danej z pamięci
while (!(SPSR & (1<<SPIF)) );   

SPSR &=~SPIF;                       //skasowanie znacznika końca transmisji
SPDR=adres;                          //przasłanie adresu danej
while (!(SPSR & (1<<SPIF)) );

SPSR &=~SPIF;                       //skasowanie znacznika końca transmisji
SPDR=33;                               //wysłanie czegokolwiek, zeby w SPDR 
                                               znalazła się wartość danej
while (!(SPSR & (1<<SPIF)) );

SPSR &=~SPIF;                       //skasowanie znacznika końca transmisji
PORTB|=0b00010000;             //CS=poziom wysoki
return SPDR;
}

void spi_init(void)
{
 PORTB|=0b00010000;
 SPCR = 0b01010000; //setup SPI
}

void SPI_WyslijDane(char adres, char data)
{
SPI_Zapis();
PORTB&=~0b00010000;		 			 	  //CS = stan niski
SPDR=0b00000010;
while (!(SPSR & (1<<SPIF)) );
SPDR=adres;
while (!(SPSR & (1<<SPIF)) );
SPDR=data;
while (!(SPSR & (1<<SPIF)) );
PORTB|=0b00010000;		   	 			  //CS = stan wysoki
while (SPI_OdbierzRejestr()==3);	  //Czekaj dopóki pamięć jest zajęta
}

char SPI_OdbierzData(char adres)
{
PORTB&=~0b00010000;		  				  //CS = stan niski
SPDR=0b00000011;
while (!(SPSR & (1<<SPIF)) );
SPDR=adres;
while (!(SPSR & (1<<SPIF)) );
SPDR=0;
while (!(SPSR & (1<<SPIF)) );
PORTB|=0b00010000;		   	 			  //CS - stan wysoki
return SPDR;
}

char SPI_OdbierzRejestr(void)
{
PORTB&=~0b00010000;			 			 //CS = stan niski
SPDR=0b00000101;
while (!(SPSR & (1<<SPIF)) );
SPDR=0;
while (!(SPSR & (1<<SPIF)) );
PORTB|=0b00010000;		   	 			//CS = stan wysoki
return SPDR;
}

void SPI_ZapiszRejestr(char rejestr)
{
char x;
SPI_Zapis();
PORTB&=~0b00010000;						//CS = stan niski
SPDR=0b00000001;
while (!(SPSR & (1<<SPIF)) );
SPDR=rejestr;
while (!(SPSR & (1<<SPIF)) );
PORTB|=0b00010000;		   	 			// CS = stan wysoki
while (SPI_OdbierzRejestr()==3);  //Czekaj dopóki pamięć jest zajęta
}

void SPI_Zapis(void)			  		//Zezwolenie na zapis do pamięci
{
PORTB&=~0b00010000;						//CS = stan niski
SPDR=0b00000110;
while (!(SPSR & (1<<SPIF)) );
PORTB|=0b00010000;		   	 			//CS = stan wysoki
}

void main(void)
{
char x=0;

init_devices();                     //tu również odpalana jest Spi_init();

SPI_WyslijDane(1,'Q');
SPI_WyslijDane(2,'L');

x=SPI_OdbierzData(1);
x=SPI_OdbierzData(2);
}