Changed several data structures associated with rigid contact to use double precision, including C_q, E_q, contact normal, contact plane, friction, cohesion, etc. Updated the APGD iterative solver to match Heyn's PhD thesis.