From 37b000d41d97e4e98412a7453970a3f139a63743 Mon Sep 17 00:00:00 2001 From: tfield Date: Fri, 14 May 2010 01:10:36 +0000 Subject: [PATCH] collada_urdf: fix mesh loading bug --- collada_urdf/src/stl_loader.cpp | 10 ++++++++-- 1 file changed, 8 insertions(+), 2 deletions(-) diff --git a/collada_urdf/src/stl_loader.cpp b/collada_urdf/src/stl_loader.cpp index 77b8b2d..4194f99 100644 --- a/collada_urdf/src/stl_loader.cpp +++ b/collada_urdf/src/stl_loader.cpp @@ -95,10 +95,16 @@ void STLLoader::readBinary() { int face_num = readLongInt(); for (int iface = 0; iface < face_num; iface++) { - Vector3 normal(readFloat(), readFloat(), readFloat()); + float nx = readFloat(); + float ny = readFloat(); + float nz = readFloat(); + Vector3 normal(nx, ny, nz); for (int i = 0; i < 3; i++) { - Vector3 vertex(readFloat(), readFloat(), readFloat()); + float vx = readFloat(); + float vy = readFloat(); + float vz = readFloat(); + Vector3 vertex(vx, vy, vz); int index = mesh_->getVertexIndex(vertex); if (index == -1) {