004 - Testing and debugging modifications

I modified some code lines in order to permform an easier debug of the
software and also the needed to run the needed tests for the included
algorithms