예제 #1
0
void KneeJointR::computeDotJachq(double time, BlockVector& workQ, BlockVector& workZ, BlockVector& workQdot)
{
  DEBUG_PRINT("KneeJointR::computeDotJachq(double time, Interaction& inter) starts \n");
  if (workQdot.getNumberOfBlocks()>1)
  {
    computeDotJachq(time, (workQdot.getAllVect())[0], (workQdot.getAllVect())[1]);
  }
  else
  {
    computeDotJachq(time, (workQdot.getAllVect())[0]);
  }
  DEBUG_PRINT("KneeJointR::computeDotJachq(double time, Interaction& inter) ends \n");
}