Testing and fixes

Samo Penic

2016-06-21 032273a4cf21e1a43038b60b8744021930c97a5b

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.