Lambda cache clearing and rigid body indexing

Lambda cache now clears everytime before ConstraitsSolver solve method
is called.
When indexing two colliding rigid bodies (A and B), A is always the RB
with smaller pointer value than B