Store solved contact forces in contact structure

* Fix #212