Проблема с выводом данных STM32f103 на LCD CMSIS

[ark]

Доброго времени суток! Недавно решил продолжить свое изучение микроконтроллеров и с AVR перейти на STM32. Понял специфику и решил применить новые знания на практике. Нашел дисплей MT-16S2H (https://www.melt.com.ru/pdf/mt-16s2h.pdf) и набросал кода для инициализации и вывода символа. Подсветка загорелась, но вывести ничего не получилось) Начал смотреть что написал. Порты инициализировал правильно, сам дисплей вроде тоже, запись данных вроде тоже. Предполагаю что косяк где-то с курсором или символ не правильно как-то вывожу:

Код: Выделить всё

	void setPos(int8_t row, int8_t col)
	{
		if (row == 0) 
			col|=0x80;
		else
			col|=0xC0;
		sendbyte(col, 0);
	}
void sendchar(char c)
	{
		sendbyte(c, 1);
	}

Код прикладываю во вложении. Кто реализовывал подобное отзовитесь пожалуйста.
Заранее спасибо за помощь)