Fix typedef for Matrix3D/Orientation3D