Fixed restoration (partially)

Samo Penic

2016-02-29 e87e4e4fcbba57d36dfd17b92f413ccf2c1b322a

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.