Инициализация дисплея

#define F_CPU 16000000L
#include <stdio.h>
#include <avr/io.h>
#include <util/delay.h>
 
#define RS PB4
#define RW PB3
#define E PB2
 
char D[16];
 
//программа записи данных в дисплей
void display_wrt(unsigned char letter)
{
    PORTB |=(1<<RS);// RS->1
    PORTB &=~(1<<RW);//RW->0
    PORTB |=(1<<E);//E->1
    _delay_ms(40);
    PORTD=0x00;
    PORTD |=letter;
    PORTB &=~(1<<E);//E->0
    _delay_ms(40);
}
void display_init(void)
{
    DDRB |=(1<<RS)|(1<<E)|(1<<RW);//ВЫВОД ДАННЫХ НА ДИСПЛЕЙ, НА ЧТЕНИЕ ДАННЫХ ИЗ КОНТРОЛЛЕРА
    PORTB=0x00;//PORTB->0
    DDRB=0xFF;//PORTB->1
    _delay_ms(50);
    PORTB &=~(1<<RS);// RS->0
    PORTB &=~(1<<RW);//RW->0
    
    PORTB |=(1<<E);//E->1
    _delay_ms(40);
    PORTD=0x30;//в порт D->0(режим работы с 8ми разр шиной)
    PORTB &=~(1<<E);//E->0
    _delay_ms(40);
    
    PORTB |=(1<<E);//E->1
    _delay_ms(40);
    PORTD=0x30;//в порт D->0(режим работы с 8ми разр шиной)
    PORTB &=~(1<<E);//E->0
    _delay_ms(40);
    
    PORTB |=(1<<E);//E->1
    _delay_ms(40);
    PORTD=0x30;//в порт D->0(режим работы с 8ми разр шиной)
    PORTB &=~(1<<E);//E->0
    _delay_ms(40);
    
    PORTB |=(1<<E);//E->1
    _delay_ms(40);
    PORTD=0x30;
    PORTB &=~(1<<E);//E->0
    _delay_ms(40);
    
    PORTB |=(1<<E);//E->1
    _delay_ms(40);
    PORTD=0x0E;//включить изображение, включение курсора, отключение мерцания
    PORTB &=~(1<<E);//E->0
    _delay_ms(40);
    PORTB |=(1<<E);//E->1
    _delay_ms(40);
    PORTD=0x06;//счетчик адреса увеличивается, сдвига экрана нет
    PORTB &=~(1<<E);//E->0
    _delay_ms(40);
    
    PORTB |=(1<<E);//E->1
    _delay_ms(40);
    PORTD=0x01;//очистка дисплея
    _delay_ms(40);
    PORTB &=~(1<<E);//E->0
}
int main(void)
{
    int t=0;
    char d=0;
    int x=0;
    int c=0;
    
    DDRC = 0x11;//0x01
    DDRD=0xFF;
    PORTC = 0x00;
    display_init();
    
    display_wrt(0x71);
    display_wrt(0x61);
    _delay_ms(100);
    
    
    while (1)
    {
        TCCR0A = 0x00;
        t=0;
        d=0;
        TCNT0 = 0;
        TCCR0B =0x01;
        PORTC |= 0x01;
        _delay_ms(1);
        TCCR0B =0x00;
        PORTC &= ~0x01;
        
        t=TCNT0*62.5*pow(10, -9);
        d=343.1*t/2;
        _delay_ms(1);
        PORTB &=~(1<<RS);// RS->0
        PORTB &=~(1<<RW);//RW->0
        PORTB |=(1<<E);//E->1   
        _delay_ms(40);
        PORTD=0x01;//очистка дисплея
        _delay_ms(40);
        PORTB |=(1<<E);//E->1
        //вывод строки
        PORTB |=(1<<RS);//RS->1
        PORTB |=(1<<E);//E->1
        _delay_ms(40);
            x=(d/10)+48;
        c=(d/10)-x;
        display_wrt(x);
        _delay_ms(10000);
        PORTB &=~(1<<E);//E->0
         _delay_ms(40);
         PORTB |=(1<<E);//E->1
         _delay_ms(40);
    }
}