Implemented Capsule Moment of Inertia function
Removed unnecessary printf calls