groundContactPoint.setVelocity(velocity); groundContactPoint.setVelocity(velocity); groundContactPoint.setVelocity(velocity);
groundContactPoint.setVelocity(velocity);
groundContactPointOnFlat.setVelocity(queryVelocityOnFlat); groundContactModelOnFlat.doGroundContact(); Vector3D forceOnFlat = new Vector3D(); groundContactPointOnSlope.setVelocity(queryVelocityOnSlope); groundContactModelOnSlope.doGroundContact();