Updated LCP solver
Added Contact class and (preliminary) contact handler