Fixes and added doocumentation

Samo Penic

2016-03-16 05548956c5a43a83542a88f6437a247f5a95146d

1
Original written by Dan Kroll in FORTRAN. Code was then largely adapted and commented by Miha Fosnaric-Fosni. Rewritten into C by Samo Penic-Peni, with help of Miha's extensive explanations.