Кирилица в Adafruit_GFX.h

Здравствуйте, помогите решить проблему.. Код работает все свои функции выполняет, но русский шрифт на матрицу выводит со смещением в один символ. Когда вывожу допустим "Абвг" выводится "Бвгд". ни как не могу победить. Есть ощущение, что проблема тут

Спойлер: utf8rus

Код (C++):

/* Recode russian fonts from UTF-8 to Windows-1251 */

String utf8rus(String source)
{
  int i,k;
  String target;
  unsigned char n;
  char m[2] = { '0', '\0' };

  k = source.length(); i = 0;

  while (i < k) {
    n = source[i]; i++;

    if (n >= 0xC0) {
      switch (n) {
        case 0xD0: {
          n = source[i]; i++;
          if (n == 0x81) { n = 0xA8; break; }
          if (n >= 0x90 && n <= 0xBF) n = n + 0x30;
          break;
        }
        case 0xD1: {
          n = source[i]; i++;
          if (n == 0x91) { n = 0xB8; break; }
          if (n >= 0x80 && n <= 0x8F) n = n + 0x70;
          break;
        }
      }
    }
    m[0] = n; target = target + String(m);
  }
return target;
}

Всё делал,как описано тут http://arduino.ru/forum/programmiro...t-gfx-i-vyvod-russkikh-bukv-na-displei-v-kodi

Сам код скетча.

Спойлер: Код

Код не влез в отведенный размер сообщения, приложил ниже архивом.

Вывод идёт на самодельную матрицу, раньше всё отображалось как надо.
Если кто то сталкивался с таким, прошу помочь. СПАСИБО....
приложу архив с необходимыми файлами

 

Вроде нашёл, что нужно поменять в файлике utf8rus. Завтра попробую.

 

Последняя версия с комментариями, "как есть". Оставлю тут для Себя.. (всё необходимое в архиве)

Спойлер: Код

https://github.com/Securond/ESP_RTC_new4

 

ВНИМАНИЕ !!!
Мой ESP Вешается от этого кода. где то через 50 минут работы !!!
Если найду причину отпишусь....

 

Исправлена ошибка приводившая к зависанию модуля ESP.
Причиной была отправка информации в топик на скорости 16Мгц )).
Исправил, перенёс отправку вместе с публикацией времени. Теперь всё норм. Обновил на гитхабе.