Finished problem 2 in C