Implement Forces

TODO:

* [x] Fix the ./test_free_energy2 test (bisect to see when it stopped working)
* [x] Reuse the FE subroutines everywhere, do not copy them anymore
* [x] Rebase/fix the XX commits