There are some contact parameters that can be used to improve contact force stability, especially the min_depth parameter (see another question/answer). For an example, please see these changes to the polaris ranger ev model.