Fixes #19.

Samo Penic

2016-09-15 3cd5f4a96d445b55da8a7e6da8509bbd7d5d41b8

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.