Merge pull request #15 from tomdepplito/test_algorithm

Algorithm is working now