void RobotDynamics3D::Subset(const RobotDynamics3D& robot,const std::vector<int>& subset) { RobotDynamics3D::Subset(robot,subset); for(size_t i=0;i<subset.size();i++) { dq(i) = robot.dq(subset[i]); torqueMax(i) = robot.torqueMax(subset[i]); velMin(i) = robot.velMin(subset[i]); velMax(i) = robot.velMax(subset[i]); powerMax(i) = robot.powerMax(subset[i]); } }