Fixed most problems, some still persists.

Samo Penic

2019-10-19 201659654a328f84c229d16fe85d8709a4183957

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.