Minor bug fixes, worked on fallingBrickLCP example.
Merge pull request #5 from mposa/collision-dynamics-integration

Minor bug fixes, worked on fallingBrickLCP example.