Adapt DartLoader::parseWorld to workaround for Issue #122.

dartsim · Jan 10, 2014 · d4b41b3 · d4b41b3
1 parent e739477
commit d4b41b3
Showing 1 changed file with 1 addition and 3 deletions.
diff --git a/src/utils/urdf/DartLoader.cpp b/src/utils/urdf/DartLoader.cpp
@@ -81,9 +81,7 @@ simulation::World* DartLoader::parseWorld(std::string _urdfFileName) {
       Eigen::Isometry3d transform = toEigen(worldInterface->models[i].origin);
 
       if(dynamic_cast<dynamics::FreeJoint*>(rootJoint)) {
-          Eigen::Vector6d coordinates;
-          coordinates << math::logMap(transform.linear()), transform.translation();
-          rootJoint->set_q(coordinates);
+          rootJoint->set_q(math::logMap(transform));
       }
       else {
           rootJoint->setTransformFromParentBodyNode(transform);