Should be an extension of code in #5 Check for conflict Calculate center of mass and and try to shift away from intersection if possible.