Almost done implementing. Need to figure out about singular Inertia tensors