Little optimisations

Reverted calculating p. Getch changed to system("pause");