Разложение числа и замена цифры значением как оптимизировать

[Petrovich12]

Добрый день форумчане. Прошу помочь с решением задачи Дейтела.
Программированием занялся недавно так что просьба не пинать сильно за код.
Текст задачи Программа должна считывать 4-х значное целое число и шифровать его следующим образом: "Заменить каждую цифру значением суммы этой цифры и 7 по модулю 10 затем поменять местами первую цифру и третью вторую и четвертую. Затем вывести зашифрованное целое число.
Прога вроде все считает за исключением: если первая цифра числа равна 0, и если третья равна 3 (тогда получается ноль и на выходе 3-х значное число). Не могу придумать как реализовать это не увеличивая разрядность числа до 8.
Ниже привожу код программы:

#include <stdio.h>
#include <iostream.h>
main()
{
int c=0,c1=0,c2=0,c3=0,c4=0,c5=0,c0, i=0;

cout << "Vvedite chislo";
cin >> c;
while (c!=0)
{c0=c%10+7;
if(c0>=10) c0-=10;
c/=10;
i++;
if(i==1) c4=c0;
if(i==2) c3=c0;
if(i==3) c2=c0;
if(i==4) c1=c0;
}
c5=10*(100*c3+10*c4+c1)+c2;

cout << "Zashifrovannoe chislo" << c5 << "\n";
cout << "shetchik " << i << "\n";
cout << "c1 " << c1 << "\n";
cout << "c2 " << c2 << "\n";
cout << "c3 " << c3 << "\n";
cout << "c4 " << c4 << "\n";
return 0;
}

[-LeV-]

cout.fill('0');
cout<<setw(4)<<c5<<"\n";

как-то так...

cout<<c3<<c4<<c1<<c2<<"\n";

или так...