Changed contactConstraints so that phi = <relpos,normal>, instead of phi = sgn(<relpos,normal>) * ||relpos||
Merge pull request #66 from mposa/master

Change to RigidBodyManipulator contactConstraints.