Algorithm completed.

Now the full algorithm should be there. The project should be converted
to a DLL and tested with random matrix data. Create this data using
matlab and also generate ground truth in form of a set of matrixes with
minimal error.