Implemented Crank Nicholson in C++