Implement Forces

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