Commit 12fbc4bb authored by Galo Maldonado's avatar Galo Maldonado
Browse files

[c++] fix commit errors for spherical joints

parent 35f0e53f
......@@ -331,7 +331,6 @@ dg::Vector Dynamic::getPinocchioPos(int time)
q(fillingIndex+1) = temp.y();
q(fillingIndex+2) = temp.z();
q(fillingIndex+3) = temp.w();
it++;
fillingIndex +=4;
origIndex +=3;
}
......@@ -341,6 +340,7 @@ dg::Vector Dynamic::getPinocchioPos(int time)
q.resize(qJoints.size());
q=qJoints;
}
sotDEBUG(15) <<"Position out"<<q<<std::endl;
sotDEBUGOUT(15);
return q;
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment