New Algorithms + fixes
Merge pull request #604 from MrConcept/algos

New Algorithms + fixes