Added some cache improvements to contact solver!