Added two new algorithms. Most stuff not in compilable state