Put tests back in algorithms.rs