//----------------------------------------------------------------------- std::vector<Matrix3x2> SkeletonHelper::ToGlobalPose(Skeleton const& skeleton, SkeletonPose const& skeletonPose) { std::vector<Matrix3x2> globalPose(skeleton.JointCount()); SkeletonHelper::ToGlobalPose(skeleton, skeletonPose, globalPose); return std::move(globalPose); }
bool CameraSystem::writeToTextFile(const std::string& filename) const { std::ofstream ofs(filename.c_str()); if (!ofs.is_open()) { return false; } ofs << std::fixed << std::setprecision(10); for (int i = 0; i < m_cameraCount; ++i) { const Eigen::Matrix4d& globalPose = m_globalPoseVec.at(i); ofs << m_cameraVec.at(i)->cameraName() << std::endl; for (int j = 0; j < 3; ++j) { for (int k = 0; k < 4; ++k) { ofs << globalPose(j,k); if (k < 3) { ofs << " "; } } ofs << std::endl; } ofs << std::endl; } ofs.close(); return true; }