Center of Mass, Translation and Scaling Done. Working on inertia tensor