Store solved contact forces in collision detector
Merge pull request #216 from dartsim/contact_force

Store solved contact forces in contact structure