pulled RHS matrix product out of loop and stored in individual constraints
Merge branch 'master' of https://github.com/rarietta/ProjectionBasedDynamics
cut iteration time down by 6x by storing premultiplied RHS p_i coefficient (all terms in sigma on RHS of global solve)