Many changes to the code to allow internal pegs

Samo Penic

2016-07-13 90882f51387b945bc0f660d8b12200b2f48e80fa

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.