Willans Formula for Primes in C++