name value map to identify joints in RBDL representation added

git-svn-id: http://svn.code.sf.net/p/simox/code/trunk@743 042f3d55-54a8-47e9-b7fb-15903f145c44

VirtualRobot/Dynamics/dynamics.cpp

@@ -175,6 +175,8 @@ void Dynamics::toRBDL(boost::shared_ptr<RigidBodyDynamics::Model> model, RobotNo
     if (joint.mJointType != JointTypeFixed)
     {
         nodeID = model->AddBody(parentID, spatial_transform, joint, body);
+        this->identifierMap[node->getName()] = nodeID;
+        //cout << node->getName() << ", " << nodeID << endl; // Debugging Info
     }
 
     std::vector<SceneObjectPtr> children;