void setTrajectoryKeyPosition(double * trajectoryKeyPositions, int * size1, int * size2) { if (TRAJECTORYKEYPOSITIONS.size() != 0) { std::cout << "You are reinitializing TrajectoryKeyPositions...\n" ; for (unsigned int i = 0; i < TRAJECTORYKEYPOSITIONS.size(); i++) TRAJECTORYKEYPOSITIONS[i].resize(0); TRAJECTORYKEYPOSITIONS.resize(0); } TRAJECTORYKEYPOSITIONS.resize(*size1); for (int i = 0; i < *size1; i++) { TRAJECTORYKEYPOSITIONS[i].resize(*size2); for (int j = 0; j < *size2; j++) TRAJECTORYKEYPOSITIONS[i][j] = trajectoryKeyPositions[i * (*size2) + j]; } }
void getTrajectoryKeyPosition(double * trajectoryKeyPositions) { for (unsigned int i = 0; i < TRAJECTORYKEYPOSITIONS.size(); i++) for (unsigned int j = 0; j < TRAJECTORYKEYPOSITIONS[0].size(); j++) trajectoryKeyPositions[i * TRAJECTORYKEYPOSITIONS[0].size() + j] = TRAJECTORYKEYPOSITIONS[i][j]; }
void getNDOF(int *size) { *size = TRAJECTORYKEYPOSITIONS.size(); }