Исправить программу: нужно перевести с 866 в 1251

#define YO (240)
#define yo (241)
 
 
#include <stdio.h>
#include <string.h>
 
 
 
  void from866to1251(char *str) 
{
    int i;
    for (i = 0; *(str + i); i++)
    {
        if (*(str+i) >= 128 && *(str + i) < 176) // Буквы от А до Я и от а до п//
        {
            *(str + i) = *(str + i) + 0x64;
        }
 
        else if (*(str + i) >= 224 && *(str + i) < 240) // буквы от р-я
        {
            *(str + i) = *(str + i) + 0x16;
        }
    }
 
}
  void from866to1251YO(char* str) // функция для вывода Ё//
  {
      int i;
      for (i = 0; *(str + i); i++)
      {
          if (*(str + i) = YO)
          {
              *(str + i) = *(str + i) - 0x73;
          }
      }
  }
 
  void from866to1251yo(char* str) // функция для вывода ё//
  {
      int i;
      for (i = 0; *(str + i); i++)
      {
          if (*(str + i) = yo)
          {
              *(str + i) = *(str + i) - 0x57;
          }
      }
  }
 
 
 
 
 int  main( void )
{
    int i;
    char str[99999999]; 
    from866to1251(str);
    from866to1251yo( str);
    from866to1251YO( str);
        gets_s(str);
    printf("%s",str);
 }

void from_cp866_to_cp1251(string &str) 
{
    for(size_t i = 0; i < str.size(); ++i) 
    {
        if ((unsigned char)str[i] == 0xF1) // для ё
            str[i] = 0xB8;
        else if ((unsigned char)str[i] == 0xF0) // для Ё
            str[i] = 0xA8;
        else if ( (unsigned char)str[i] > 0x7F && (unsigned char)str[i] < 0xB0 )
            str[i] += 0x40;
        else if ((unsigned char)str[i] > 0xDF && (unsigned char)str[i] < 0xF0)
                    str[i] += 0x10;
    }
}

#include <windows.h>
void from_cp866_to_cp1251(char* str) 
{
    OemToChar(str,str);
}