Working commit.
Working commit.
Changes to solveLCP for new contact formulation.