Проблема с выводом данных 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);
   }


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