metapodfromurdf: fix inertia matrix rotation

This bug went unoticed since both simple_{arm,humanoid} urdf models have
identity rotation matrices.

Many thanks to Joseph Salini for the report, the fix and the testing ;)

Change-Id: I3531fd47f01ed52574eec64d3929aaf45080f753