Update to use the new Matrix3d class from j3d-core