LCD 1602 инициализация только после Reset

// Инициализация
  BusWidth width = this->mBusWidth;
 
  this->mBusWidth = BusWidth::Bit8;
 
  this->functionSet(BusWidth::Bit8, CharGeneratorPage::First);
  this->functionSet(BusWidth::Bit8, CharGeneratorPage::First);
  this->functionSet(BusWidth::Bit8, CharGeneratorPage::First);
 
  if (width == BusWidth::Bit4) {
    this->functionSet(BusWidth::Bit4, CharGeneratorPage::First);
    this->waitWhileBusy();
 
    this->mBusWidth = BusWidth::Bit4;
 
    this->functionSet(BusWidth::Bit4, CharGeneratorPage::First);
    this->waitWhileBusy();
  }
 
  this->displayControl(false, false, false);
  this->waitWhileBusy();
 
  this->clearDisplay();
  this->waitWhileBusy();
 
  this->entryModeSet(ScrollMode::CursorRight);
  this->waitWhileBusy();
 
  //
  this->functionSet(BusWidth::Bit4, CharGeneratorPage::Second);
  this->displayEnable(true);

void DisplayHD44780Common::functionSet(BusWidth width, CharGeneratorPage page)
{
  this->setA0(A0Mode::Command);
  this->setRW(ModeDirection::Write);
  uint8_t data = 0x28;
 
  switch (width) {
    case BusWidth::Bit4: {
      data |= 0x00;
      break;
    }
 
    case BusWidth::Bit8: {
      data |= 0x10;
      break;
    }
 
    default: {
      return;
    }
  }
 
  switch (page) {
    case CharGeneratorPage::First: {
      data |= 0x00;
      break;
    }
 
    case CharGeneratorPage::Second: {
      data |= 0x02;
      break;
    }
 
    default: {
      return;
    }
  }
 
  this->writeBits(data);
}

void DisplayHD44780Common::displayControl(bool enableDisplay, bool showCursor, bool blink)
{
  this->setA0(A0Mode::Command);
  this->setRW(ModeDirection::Write);
  uint8_t data = 0x08;
 
  if (enableDisplay) {
    data |= 0x04;
  }
 
  if (showCursor) {
    data |= 0x02;
  }
 
  if (blink) {
    data |= 0x01;
  }
 
  this->writeBits(data);
}

void DisplayHD44780Common::clearDisplay()
{
  this->setA0(A0Mode::Command);
  this->setRW(ModeDirection::Write);
  this->writeBits(0x01);
}

void DisplayHD44780Common::entryModeSet(ScrollMode value)
{
  this->setA0(A0Mode::Command);
  this->setRW(ModeDirection::Write);
  uint8_t data = 0x04;
 
  switch (value) {
    case ScrollMode::CursorLeft: {
      data |= 0;
      break;
    }
 
    case ScrollMode::CursorRight: {
      data |= 0x02;
      break;
    }
 
    case ScrollMode::DisplayLeft: {
      data |= 0x03;
      break;
    }
 
    case ScrollMode::DisplayRight: {
      data |= 0x01;
      break;
    }
 
    default: {
      return;
    }
  }
 
  this->writeBits(data);
}

  enum class ModeDirection
  {
    Write,
    Read
  };
 
  enum class A0Mode
  {
    Command,
    Data
  };
 
  enum class ScrollMode
  {
    CursorLeft,
    CursorRight,
    DisplayLeft,
    DisplayRight
  };
 
  enum class CharGeneratorPage
  {
    First,
    Second
  };
 
  enum class BusWidth
  {
    Bit4,
    Bit8
  };