Started implementing solver in c++