Added some documentation,
All utilities for the algorithm are present now (I think...)