Basic refactoring with the find mu algorithm

findmu.cpp is ready to be tested