Made a fix to the Sticking/Slipping check (pose correction: new
    contact_point.pose & rvel to GLOBAL).  Changed Restring Contact LCP
fail into RestingContactFailException combined with EnergyGainException.