Add center of mass tracking
Merge pull request #11 from KevinGrandon/add_center_of_mass_tracking

Add center of mass tracking