Function copyImageMatrix

src/detect_grasps_python.cpp:331–341

}

void copyImageMatrix(const cv::Mat &src, cv::Mat &dst, int idx_in) {
  for (int j = 0; j < 60; j++) {
    for (int k = 0; k < 60; k++) {
      for (int l = 0; l < 15; l++) {
        int idx_src[3] = {j, k, l};
        int idx_dst[4] = {idx_in, j, k, l};
        dst.at<uchar>(idx_dst) = src.at<uchar>(idx_src);
      }
    }
  }
}

void handToTransform4x4(const Hand &hand, cv::Mat &tf, int idx_in) {
  const Eigen::Matrix3d orient = hand.getFrame();