fix index of starting point of rotation component in inertia matrix

Fix index of starting point of rotation component in inertia matrix.