replace strcmpi with ismember to get rid of order dependence in group name cell arrays
add contact_groups argument to getTerrainContactPoints
update cost function comment
support contact groups in RigidBodySupportState