Fixed x-y bug for force

Miha

2016-07-15 c372c14d1f552a3219a733394141179c9e800683

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.