added center of mass distribution, fixed contact point distribution, created visualizations and merged code