LCD TQL16D2-1 bascom

void lcd_init(void)		// procedura inicjalizacji wyświetlacza LCD
{unsigned char LCD = 255 //Zmienna z bajtem do zaposania w LCD
	delayms(100); 	// czekaj 15ms na ustabilizowanie się napięcia zasilającego
	CLR_E; 	// Ustaw E na 0
	CLR_RS; // Ustaw RS na 0
	char i; // zmianna licznikowa
	for(i = 0; i < 3; i++) // trzykrotne powtórzenie bloku instrukcji
	{
		LCD &= 0x3F;// Zachowaj w zmiennej LCD bity w miejscach gdzie w masce (00111111) są jedynki, resztę wyzeruj.
		SET_E; 		// E = 1
		ustaw(LCD);	// Wyślij daną do LCD
		CLR_E; 		// E = 0
		waitms(5); 	// czekaj 5ms
	}
	LCD &= 0x2F;	// Zachowaj w zmiennej LCD bity w miejscach gdzie w masce (00101111) są jedynki, resztę wyzeruj.
	SET_E; 			// E = 1
	ustaw(LCD);		// Wyślij daną do LCD
	CLR_E; 			// E = 0
	waitms(1); 		// czekaj 1ms
	// Konfiguracja
	write_command(0x28); // interfejs 4-bity, 2-linie, znak 5x7
	write_command(0x08); // wyłącz LCD, kursor i miganie
	cls; 				 // czyść LCD
	write_command(0x06); // bez przesuwania w prawo
	write_command(0x0C); // włącz LCD, bez kursora i mrugania
}

void write_command(char x) // procedura zapisu instrukcji do wyświetlacza LCD
{
	CLR_RS; 			// niski stan na RS -> zapis instrukcji
	write_to_lcd(x); 	// zapis do LCD
}

void write_to_lcd(char x) // procededura zapisu bajtu do wyświetlacza LCD
{
	SET_E; 				  // ustaw na E stan wysoki
	ustaw(x);			  // Wyślij daną do LCD
	CLR_E; 				  // opadające zbocze na E -> zapis do wyświetlacza
	SET_E; 				  // ustaw na E stan wysoki
	ustaw(x<<4);		  // Wyślij daną do LCD przesuniętą o 4 miejsca w lewo
	CLR_E; 				  // opadające zbocze na E -> zapis do wyświetlacza
	delayms(1); 		  // czekaj 1ms
}