ProjectStore.cpp 27 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672
  1. // Include own headers
  2. #include "ProjectStore.hpp"
  3. // Include modules
  4. #include "MainWindow.hpp"
  5. #include "StringBasics.hpp"
  6. #include "TrackPointRenderer.hpp"
  7. #include "PlatformSupport.hpp"
  8. #include "STLImport.hpp"
  9. #include "MeshTools.hpp"
  10. // Include dependencies
  11. #include <typeinfo>
  12. #include <iostream>
  13. #include <filesystem>
  14. #define META_NAMESPACE "tk-ar-tracking"
  15. ProjectStore::ProjectStore(QObject* parent): QObject() {
  16. _projectLoaded = false;
  17. _projectModified = false;
  18. load3mfLib();
  19. }
  20. ProjectStore::~ProjectStore() {
  21. }
  22. void ProjectStore::loadMesh(std::string meshFile) {
  23. if (meshFile == "") {
  24. return;
  25. }
  26. if (StringBasics::endsWithCaseInsensitive(meshFile, ".STL")) {
  27. _projectLoaded = true;
  28. _projectModified = false;
  29. // Read STL file
  30. std::vector<Lib3MF::sPosition> verticesBuffer;
  31. std::vector<Lib3MF::sTriangle> triangleBuffer;
  32. STLImport::readSTL(meshFile, &verticesBuffer, &triangleBuffer);
  33. Lib3MF::PMeshObject baseMesh = _project->AddMeshObject();
  34. baseMesh->SetGeometry(verticesBuffer, triangleBuffer);
  35. render3MFMesh();
  36. MainWindow::getInstance()->renderView(Edit);
  37. } else if (StringBasics::endsWithCaseInsensitive(meshFile, ".3MF")) {
  38. _projectLoaded = true;
  39. _projectModified = false;
  40. // Read 3MF file
  41. Lib3MF::PReader reader = _project->QueryReader("3mf");
  42. reader->ReadFromFile(meshFile);
  43. render3MFMesh();
  44. MainWindow::getInstance()->renderView(Edit);
  45. } else {
  46. MainWindow::getInstance()->showErrorMessage("Unsupported file type. Please use .stl or .3mf files.", "Error opening file.");
  47. }
  48. }
  49. bool ProjectStore::loadProject(std::string projectFile) {
  50. if (projectFile == "") {
  51. return false;
  52. }
  53. if (!_projectLoaded) {
  54. Lib3MF::PReader reader = _project->QueryReader("3mf");
  55. reader->ReadFromFile(projectFile);
  56. _projectLoaded = true;
  57. _projectModified = false;
  58. _projectFile = projectFile;
  59. loadMetaData();
  60. return true;
  61. }
  62. return false;
  63. }
  64. bool ProjectStore::saveProject() {
  65. if (_projectFile != "") {
  66. return saveProject(_projectFile);
  67. }
  68. return false;
  69. }
  70. bool ProjectStore::saveProject(std::string path) {
  71. if (path == "") {
  72. return false;
  73. }
  74. updateMetaData();
  75. Lib3MF::PWriter writer = _project->QueryWriter("3mf");
  76. writer->WriteToFile(path);
  77. _projectFile = path;
  78. _projectModified = false;
  79. return true;
  80. }
  81. bool ProjectStore::exportProject(std::string path, ExportSettings settings) {
  82. if (path == "") {
  83. return false;
  84. }
  85. MainWindow::getInstance()->getEditWiget()->setExportAvailable(false);
  86. _exportPath = path;
  87. // Base for rendering mesh
  88. Lib3MF::PWriter writer = _project->QueryWriter("3mf");
  89. writer->WriteToFile(std::filesystem::temp_directory_path().u8string() + fileDelimiter + "trackpointapp_export.3mf");
  90. // Store export settings
  91. _wantedExports = 0;
  92. _doneExports = 0;
  93. _currentExportSettings = settings;
  94. if (settings.OptiTrack) _wantedExports++;
  95. if (settings.EMFTrack) _wantedExports++;
  96. if (settings.SteamVRTrack) _wantedExports++;
  97. MainWindow::getInstance()->getEditWiget()->setExportStatus(_wantedExports, _doneExports);
  98. if (settings.OptiTrack) {
  99. _optiTrackRenderThread = QThread::create(renderOptiTrackInThread, _optiTrackPoints);
  100. _optiTrackRenderThread->setObjectName("TrackpointApp OptiTrack Renderer");
  101. QObject::connect(_optiTrackRenderThread, &QThread::finished, this, &ProjectStore::renderThreadDone);
  102. _optiTrackRenderThread->start();
  103. }
  104. if (settings.EMFTrack) {
  105. _emfTrackRenderThread = QThread::create(renderEMFTrackInThread, _emfTrackPoints);
  106. _emfTrackRenderThread->setObjectName("TrackpointApp EMFTrack Renderer");
  107. QObject::connect(_emfTrackRenderThread, &QThread::finished, this, &ProjectStore::renderThreadDone);
  108. _emfTrackRenderThread->start();
  109. }
  110. if (settings.SteamVRTrack) {
  111. _steamVrTrackRenderThread = QThread::create(renderSteamVRTrackInThread, _steamVrTrackPoints);
  112. _steamVrTrackRenderThread->setObjectName("TrackpointApp SteamVR Track Renderer");
  113. QObject::connect(_steamVrTrackRenderThread, &QThread::finished, this, &ProjectStore::renderThreadDone);
  114. _steamVrTrackRenderThread->start();
  115. }
  116. _exportRunning = true;
  117. return true;
  118. }
  119. bool ProjectStore::isProjectOpen() {
  120. return _projectLoaded;
  121. }
  122. void ProjectStore::closeProject() {
  123. _projectLoaded = false;
  124. _projectModified = false;
  125. reset();
  126. }
  127. bool ProjectStore::isModified() {
  128. return _projectModified;
  129. }
  130. bool ProjectStore::isRendering() {
  131. return _exportRunning;
  132. }
  133. void ProjectStore::projectModified() {
  134. _projectModified = true;
  135. }
  136. TrackPoint* ProjectStore::getTrackPointById(int id, ActiveTrackingSystem activeTrackingSystem) {
  137. switch(activeTrackingSystem) {
  138. case OptiTrack: {
  139. return _optiTrackPoints[id];
  140. };
  141. case EMFTrack: {
  142. return _emfTrackPoints[id];
  143. };
  144. case SteamVRTrack: {
  145. return _steamVrTrackPoints[id];
  146. };
  147. case ActionPoints: {
  148. return _actionPoints[id];
  149. };
  150. }
  151. }
  152. void ProjectStore::addTrackPoint(osg::Vec3 point, osg::Vec3 normal, ActiveTrackingSystem activeTrackingSystem) {
  153. switch(activeTrackingSystem) {
  154. case OptiTrack: {
  155. OptiTrackPoint* optiTrackPoint = new OptiTrackPoint(point, normal, _normalModifier, _normalRotation, _compensation, _optiTrackSettings.length, _optiTrackSettings.radius);
  156. _optiTrackPoints.push_back(optiTrackPoint);
  157. MeshTools::optiTrackSanityCheck(_optiTrackPoints, false);
  158. break;
  159. }
  160. case EMFTrack: {
  161. normal = normal.operator*(-1.0f);
  162. EMFTrackPoint* emfTrackPoint = new EMFTrackPoint(point, normal, _normalModifier, _normalRotation, _compensation, _emfTrackSettings.width, _emfTrackSettings.height, _emfTrackSettings.depth);
  163. _emfTrackPoints.push_back(emfTrackPoint);
  164. break;
  165. }
  166. case SteamVRTrack: {
  167. SteamVRTrackPoint* steamVrTrackPoint = new SteamVRTrackPoint(point, normal, _normalModifier, _normalRotation, _compensation, _steamVrTrackSettings.length);
  168. _steamVrTrackPoints.push_back(steamVrTrackPoint);
  169. break;
  170. }
  171. case ActionPoints: {
  172. ActionPoint* actionPoint = new ActionPoint(point, normal, _normalModifier, _normalRotation, _compensation, _actionPointSettings.identifier);
  173. _actionPoints.push_back(actionPoint);
  174. break;
  175. }
  176. }
  177. projectModified();
  178. MainWindow::getInstance()->getEditWiget()->updateTrackpointCount();
  179. }
  180. int ProjectStore::getCount(ActiveTrackingSystem activeTrackingSystem) {
  181. switch(activeTrackingSystem) {
  182. case OptiTrack: {
  183. return _optiTrackPoints.size();
  184. };
  185. case EMFTrack: {
  186. return _emfTrackPoints.size();
  187. };
  188. case SteamVRTrack: {
  189. return _steamVrTrackPoints.size();
  190. };
  191. case ActionPoints: {
  192. return _actionPoints.size();
  193. };
  194. }
  195. }
  196. void ProjectStore::removeTrackPoint(int id, ActiveTrackingSystem activeTrackingSystem) {
  197. switch(activeTrackingSystem) {
  198. case OptiTrack: {
  199. _optiTrackPoints.erase(_optiTrackPoints.begin() + id);
  200. break;
  201. }
  202. case EMFTrack: {
  203. _emfTrackPoints.erase(_emfTrackPoints.begin() + id);
  204. break;
  205. }
  206. case SteamVRTrack: {
  207. _steamVrTrackPoints.erase(_steamVrTrackPoints.begin() + id);
  208. break;
  209. }
  210. case ActionPoints: {
  211. _actionPoints.erase(_actionPoints.begin() + id);
  212. break;
  213. }
  214. }
  215. projectModified();
  216. MainWindow::getInstance()->getEditWiget()->updateTrackpointCount();
  217. }
  218. void ProjectStore::updateNormalModifier(osg::Vec3 modifier) {
  219. _normalModifier = modifier;
  220. }
  221. osg::Vec3 ProjectStore::getNormalModifier() {
  222. return _normalModifier;
  223. }
  224. void ProjectStore::updateNormalRotation(float normalRotation) {
  225. _normalRotation = normalRotation;
  226. }
  227. float ProjectStore::getNormalRotation() {
  228. return _normalRotation;
  229. }
  230. void ProjectStore::updateCompensation(bool compensation) {
  231. _compensation = compensation;
  232. }
  233. bool ProjectStore::getCompensation() {
  234. return _compensation;
  235. }
  236. std::vector<OptiTrackPoint*> ProjectStore::getOptiTrackPoints() {
  237. return _optiTrackPoints;
  238. }
  239. void ProjectStore::updateOptiTrackSettings(OptiTrackSettings optiTrackSettings) {
  240. _optiTrackSettings = optiTrackSettings;
  241. }
  242. OptiTrackSettings ProjectStore::getOptiTrackSettings() {
  243. return _optiTrackSettings;
  244. }
  245. std::vector<EMFTrackPoint*> ProjectStore::getEMFTrackPoints() {
  246. return _emfTrackPoints;
  247. }
  248. void ProjectStore::updateEMFTrackSettings(EMFTrackSettings emfTrackSettings) {
  249. _emfTrackSettings = emfTrackSettings;
  250. }
  251. EMFTrackSettings ProjectStore::getEMFTrackSettings() {
  252. return _emfTrackSettings;
  253. }
  254. std::vector<SteamVRTrackPoint*> ProjectStore::getSteamVRTrackPoints() {
  255. return _steamVrTrackPoints;
  256. }
  257. void ProjectStore::updateSteamVRTrackSettings(SteamVRTrackSettings steamVrTrackSettings) {
  258. _steamVrTrackSettings = steamVrTrackSettings;
  259. }
  260. SteamVRTrackSettings ProjectStore::getSteamVRTrackSettings() {
  261. return _steamVrTrackSettings;
  262. }
  263. std::vector<ActionPoint*> ProjectStore::getActionPoints() {
  264. return _actionPoints;
  265. }
  266. void ProjectStore::updateActionPointSettings(ActionPointSettings actionPointSettings) {
  267. _actionPointSettings = actionPointSettings;
  268. }
  269. ActionPointSettings ProjectStore::getActionPointSettings() {
  270. return _actionPointSettings;
  271. }
  272. unsigned int ProjectStore::actionPointIdentifierInUse(std::string candidate, int current) {
  273. unsigned int count = 0;
  274. int i = 0;
  275. for (ActionPoint* actionPoint: _actionPoints) {
  276. if (i != current && candidate.compare(actionPoint->getIdentifier()) == 0) {
  277. count++;
  278. }
  279. i++;
  280. }
  281. return count;
  282. }
  283. void ProjectStore::renderThreadDone() {
  284. _doneExports++;
  285. MainWindow::getInstance()->getEditWiget()->setExportStatus(_wantedExports, _doneExports);
  286. if (_wantedExports == _doneExports) {
  287. // Export file
  288. Lib3MF::PModel exportModel = _wrapper->CreateModel();
  289. Lib3MF::PMetaDataGroup metaData = exportModel->GetMetaDataGroup();
  290. if (_currentExportSettings.OptiTrack) {
  291. Lib3MF::PModel optiTrackModel = _wrapper->CreateModel();
  292. Lib3MF::PReader reader = optiTrackModel->QueryReader("3mf");
  293. reader->ReadFromFile(std::filesystem::temp_directory_path().u8string() + fileDelimiter + "trackpointapp_render_optitrack.3mf");
  294. Lib3MF::PMeshObjectIterator meshIterator = optiTrackModel->GetMeshObjects();
  295. if (meshIterator->Count() == 1) {
  296. meshIterator->MoveNext();
  297. Lib3MF::PMeshObject renderedMesh = meshIterator->GetCurrentMeshObject();
  298. Lib3MF::PMeshObject exportMesh = exportModel->AddMeshObject();
  299. exportMesh->SetName("optitrack");
  300. std::vector<Lib3MF::sPosition> verticesBuffer;
  301. std::vector<Lib3MF::sTriangle> triangleBuffer;
  302. renderedMesh->GetVertices(verticesBuffer);
  303. renderedMesh->GetTriangleIndices(triangleBuffer);
  304. exportMesh->SetGeometry(verticesBuffer, triangleBuffer);
  305. json trackpointData = json::array();
  306. for (OptiTrackPoint* point: _optiTrackPoints) {
  307. osg::Vec3 trackPoint = point->getTrackPoint();
  308. osg::Vec3 trackNormal = point->getNormal();
  309. json pointData = {
  310. {"point", {trackPoint.x(), trackPoint.y(), trackPoint.z()}},
  311. {"normal", {trackNormal.x(), trackNormal.y(), trackNormal.z()}}
  312. };
  313. trackpointData.push_back(pointData);
  314. }
  315. Lib3MF::PMetaDataGroup optiMetaData = exportMesh->GetMetaDataGroup();
  316. optiMetaData->AddMetaData(META_NAMESPACE, "trackpoints-optitrack", trackpointData.dump(), "string", true);
  317. exportModel->AddBuildItem(exportMesh.get(), _wrapper->GetIdentityTransform());
  318. } else {
  319. MainWindow::getInstance()->showErrorMessage("An error occured while rendering OptiTrack model: inconsistent data.", "Error exporting project.");
  320. }
  321. }
  322. if (_currentExportSettings.EMFTrack) {
  323. Lib3MF::PModel emfTrackModel = _wrapper->CreateModel();
  324. Lib3MF::PReader reader = emfTrackModel->QueryReader("3mf");
  325. reader->ReadFromFile(std::filesystem::temp_directory_path().u8string() + fileDelimiter + "trackpointapp_render_emftrack.3mf");
  326. Lib3MF::PMeshObjectIterator meshIterator = emfTrackModel->GetMeshObjects();
  327. if (meshIterator->Count() == 1) {
  328. meshIterator->MoveNext();
  329. Lib3MF::PMeshObject renderedMesh = meshIterator->GetCurrentMeshObject();
  330. Lib3MF::PMeshObject exportMesh = exportModel->AddMeshObject();
  331. exportMesh->SetName("emftrack");
  332. std::vector<Lib3MF::sPosition> verticesBuffer;
  333. std::vector<Lib3MF::sTriangle> triangleBuffer;
  334. renderedMesh->GetVertices(verticesBuffer);
  335. renderedMesh->GetTriangleIndices(triangleBuffer);
  336. exportMesh->SetGeometry(verticesBuffer, triangleBuffer);
  337. json trackpointData = json::array();
  338. for (EMFTrackPoint* point: _emfTrackPoints) {
  339. osg::Vec3 moveToMid = point->getNormal().operator*(-(point->getDepth() / 2));
  340. osg::Vec3 trackPoint = point->getTrackPoint().operator+(moveToMid);
  341. osg::Vec3 trackNormal = point->getNormal();
  342. json pointData = {
  343. {"point", {trackPoint.x(), trackPoint.y(), trackPoint.z()}},
  344. {"normal", {trackNormal.x(), trackNormal.y(), trackNormal.z()}},
  345. {"rotation", point->getNormalRotation()}
  346. };
  347. trackpointData.push_back(pointData);
  348. }
  349. Lib3MF::PMetaDataGroup emfMetaData = exportMesh->GetMetaDataGroup();
  350. emfMetaData->AddMetaData(META_NAMESPACE, "trackpoints-emftrack", trackpointData.dump(), "string", true);
  351. exportModel->AddBuildItem(exportMesh.get(), _wrapper->GetIdentityTransform());
  352. } else {
  353. MainWindow::getInstance()->showErrorMessage("An error occured while rendering EMFTrack model: inconsistent data.", "Error exporting project.");
  354. }
  355. }
  356. if (_currentExportSettings.SteamVRTrack) {
  357. Lib3MF::PModel steamVrTrackModel = _wrapper->CreateModel();
  358. Lib3MF::PReader reader = steamVrTrackModel->QueryReader("3mf");
  359. reader->ReadFromFile(std::filesystem::temp_directory_path().u8string() + fileDelimiter + "trackpointapp_render_steamvrtrack.3mf");
  360. Lib3MF::PMeshObjectIterator meshIterator = steamVrTrackModel->GetMeshObjects();
  361. if (meshIterator->Count() == 1) {
  362. meshIterator->MoveNext();
  363. Lib3MF::PMeshObject renderedMesh = meshIterator->GetCurrentMeshObject();
  364. Lib3MF::PMeshObject exportMesh = exportModel->AddMeshObject();
  365. exportMesh->SetName("steamvrtrack");
  366. std::vector<Lib3MF::sPosition> verticesBuffer;
  367. std::vector<Lib3MF::sTriangle> triangleBuffer;
  368. renderedMesh->GetVertices(verticesBuffer);
  369. renderedMesh->GetTriangleIndices(triangleBuffer);
  370. exportMesh->SetGeometry(verticesBuffer, triangleBuffer);
  371. json trackpointData = json::array();
  372. for (SteamVRTrackPoint* point: _steamVrTrackPoints) {
  373. osg::Vec3 trackPoint = point->getTrackPoint();
  374. osg::Vec3 trackNormal = point->getNormal();
  375. json pointData = {
  376. {"point", {trackPoint.x(), trackPoint.y(), trackPoint.z()}},
  377. {"normal", {trackNormal.x(), trackNormal.y(), trackNormal.z()}}
  378. };
  379. trackpointData.push_back(pointData);
  380. }
  381. Lib3MF::PMetaDataGroup steamVrMetaData = exportMesh->GetMetaDataGroup();
  382. steamVrMetaData->AddMetaData(META_NAMESPACE, "trackpoints-steamvrtrack", trackpointData.dump(), "string", true);
  383. exportModel->AddBuildItem(exportMesh.get(), _wrapper->GetIdentityTransform());
  384. } else {
  385. MainWindow::getInstance()->showErrorMessage("An error occured while rendering SteamVR Track model: inconsistent data.", "Error exporting project.");
  386. }
  387. }
  388. // Export action point metadata
  389. json actionPointData;
  390. for (ActionPoint* point: _actionPoints) {
  391. osg::Vec3 translation = point->getTranslation();
  392. osg::Vec3 normal = point->getNormal();
  393. actionPointData[point->getIdentifier()] = {
  394. {"point", {translation.x(), translation.y(), translation.z()}},
  395. {"normal", {normal.x(), normal.y(), normal.z()}}
  396. };
  397. }
  398. metaData->AddMetaData(META_NAMESPACE, "trackpoints-actionpoints", actionPointData.dump(), "string", true);
  399. Lib3MF::PWriter exportWriter = exportModel->QueryWriter("3mf");
  400. exportWriter->WriteToFile(_exportPath);
  401. _exportRunning = false;
  402. MainWindow::getInstance()->getEditWiget()->setExportAvailable(true);
  403. }
  404. }
  405. void ProjectStore::load3mfLib() {
  406. _wrapper = Lib3MF::CWrapper::loadLibrary();
  407. _project = _wrapper->CreateModel();
  408. }
  409. void ProjectStore::reset() {
  410. _project = _wrapper->CreateModel();
  411. _optiTrackPoints.clear();
  412. _steamVrTrackPoints.clear();
  413. _actionPoints.clear();
  414. _optiTrackSettings = OptiTrackSettings {OPTITRACK_DEFAULT_LENGTH, OPTITRACK_DEFAULT_RADIUS};
  415. _steamVrTrackSettings = SteamVRTrackSettings {STEAMVR_DEFAULT_LENGTH};
  416. _actionPointSettings = ActionPointSettings {ACTIONPOINT_DEFAULT_IDENFIFIER};
  417. _normalModifier = osg::Vec3(0.0f, 0.0f, 0.0f);
  418. }
  419. void ProjectStore::render3MFMesh() {
  420. // Get meshes
  421. Lib3MF::PMeshObjectIterator meshIterator = _project->GetMeshObjects();
  422. // Our use case supports just a single mesh per project
  423. if (meshIterator->Count() != 1) {
  424. MainWindow::getInstance()->showErrorMessage("The input file contains more than one mesh. Currently, we don't support this case, so the first mesh will be used.", "Input file error.");
  425. }
  426. meshIterator->MoveNext();
  427. Lib3MF::PMeshObject mesh = meshIterator->GetCurrentMeshObject();
  428. // Load vertices and triangles and render them
  429. std::vector<Lib3MF::sPosition> verticesBuffer;
  430. mesh->GetVertices(verticesBuffer);
  431. std::vector<Lib3MF::sTriangle> triangleBuffer;
  432. mesh->GetTriangleIndices(triangleBuffer);
  433. // Create osg style arrays
  434. osg::ref_ptr<osg::Vec3Array> vertices = new osg::Vec3Array;
  435. osg::ref_ptr<osg::Vec3Array> normals = new osg::Vec3Array;
  436. // Convert data to osg format and calculate vertex normals
  437. MeshTools::calculateNormals(verticesBuffer, triangleBuffer, vertices, normals);
  438. // Call renderer
  439. MainWindow* mainWindow = MainWindow::getInstance();
  440. mainWindow->getOsgWidget()->renderBaseMesh(vertices, normals);
  441. }
  442. void ProjectStore::updateMetaData() {
  443. Lib3MF::PMetaDataGroup metaData = _project->GetMetaDataGroup();
  444. try {
  445. Lib3MF::PMetaData versionInformation = metaData->GetMetaDataByKey(META_NAMESPACE, "format");
  446. } catch (Lib3MF::ELib3MFException &e) {
  447. metaData->AddMetaData(META_NAMESPACE, "format", "1.0.0", "string", true);
  448. }
  449. json optiTrackData = json::array();
  450. for (OptiTrackPoint* optiTrackPoint: _optiTrackPoints) {
  451. optiTrackData.push_back({
  452. {"point", osgVecToStdVec(optiTrackPoint->getTranslation())},
  453. {"normal", osgVecToStdVec(optiTrackPoint->getNormal())},
  454. {"normalModifier", osgVecToStdVec(optiTrackPoint->getNormalModifier())},
  455. {"normalRotation", optiTrackPoint->getNormalRotation()},
  456. {"compensation", optiTrackPoint->getCompensation()},
  457. {"length", optiTrackPoint->getLength()},
  458. {"radius", optiTrackPoint->getRadius()}
  459. });
  460. }
  461. try {
  462. Lib3MF::PMetaData optiTrackPoints = metaData->GetMetaDataByKey(META_NAMESPACE, "optitrack");
  463. optiTrackPoints->SetValue(optiTrackData.dump());
  464. } catch (Lib3MF::ELib3MFException &e) {
  465. metaData->AddMetaData(META_NAMESPACE, "optitrack", optiTrackData.dump(), "string", true);
  466. }
  467. json emfTrackData = json::array();
  468. for (EMFTrackPoint* emfTrackPoint: _emfTrackPoints) {
  469. emfTrackData.push_back({
  470. {"point", osgVecToStdVec(emfTrackPoint->getTranslation())},
  471. {"normal", osgVecToStdVec(emfTrackPoint->getNormal())},
  472. {"normalModifier", osgVecToStdVec(emfTrackPoint->getNormalModifier())},
  473. {"normalRotation", emfTrackPoint->getNormalRotation()},
  474. {"compensation", emfTrackPoint->getCompensation()},
  475. {"width", emfTrackPoint->getWidth()},
  476. {"height", emfTrackPoint->getHeight()},
  477. {"depth", emfTrackPoint->getDepth()}
  478. });
  479. }
  480. try {
  481. Lib3MF::PMetaData emfTrackPoints = metaData->GetMetaDataByKey(META_NAMESPACE, "emftrack");
  482. emfTrackPoints->SetValue(emfTrackData.dump());
  483. } catch (Lib3MF::ELib3MFException &e) {
  484. metaData->AddMetaData(META_NAMESPACE, "emftrack", emfTrackData.dump(), "string", true);
  485. }
  486. json steamVrTrackData = json::array();
  487. for (SteamVRTrackPoint* steamVrTrackPoint: _steamVrTrackPoints) {
  488. steamVrTrackData.push_back({
  489. {"point", osgVecToStdVec(steamVrTrackPoint->getTranslation())},
  490. {"normal", osgVecToStdVec(steamVrTrackPoint->getNormal())},
  491. {"normalModifier", osgVecToStdVec(steamVrTrackPoint->getNormalModifier())},
  492. {"normalRotation", steamVrTrackPoint->getNormalRotation()},
  493. {"compensation", steamVrTrackPoint->getCompensation()},
  494. {"length", steamVrTrackPoint->getLength()}
  495. });
  496. }
  497. try {
  498. Lib3MF::PMetaData steamVrTrackPoints = metaData->GetMetaDataByKey(META_NAMESPACE, "steamvrtrack");
  499. steamVrTrackPoints->SetValue(steamVrTrackData.dump());
  500. } catch (Lib3MF::ELib3MFException &e) {
  501. metaData->AddMetaData(META_NAMESPACE, "steamvrtrack", steamVrTrackData.dump(), "string", true);
  502. }
  503. json actionPointData = json::array();
  504. for (ActionPoint* actionPoint: _actionPoints) {
  505. actionPointData.push_back({
  506. {"point", osgVecToStdVec(actionPoint->getTranslation())},
  507. {"normal", osgVecToStdVec(actionPoint->getNormal())},
  508. {"normalModifier", osgVecToStdVec(actionPoint->getNormalModifier())},
  509. {"normalRotation", actionPoint->getNormalRotation()},
  510. {"compensation", actionPoint->getCompensation()},
  511. {"identifier", actionPoint->getIdentifier()}
  512. });
  513. }
  514. try {
  515. Lib3MF::PMetaData actionPoints = metaData->GetMetaDataByKey(META_NAMESPACE, "actionpoints");
  516. actionPoints->SetValue(actionPointData.dump());
  517. } catch (Lib3MF::ELib3MFException &e) {
  518. metaData->AddMetaData(META_NAMESPACE, "actionpoints", actionPointData.dump(), "string", true);
  519. }
  520. }
  521. void ProjectStore::loadMetaData() {
  522. Lib3MF::PMetaDataGroup metaData = _project->GetMetaDataGroup();
  523. try {
  524. Lib3MF::PMetaData versionInformation = metaData->GetMetaDataByKey(META_NAMESPACE, "format");
  525. } catch (Lib3MF::ELib3MFException &e) {
  526. MainWindow::getInstance()->showErrorMessage("This is not a valid TrackpointApp project.", "Error opening project file.");
  527. }
  528. Lib3MF::PMetaData optiTrackString;
  529. try {
  530. optiTrackString = metaData->GetMetaDataByKey(META_NAMESPACE, "optitrack");
  531. auto optiTrackData = json::parse(optiTrackString->GetValue());
  532. _optiTrackPoints.clear();
  533. for (const auto pointData: optiTrackData) {
  534. osg::Vec3f point = osg::Vec3f(pointData["point"][0], pointData["point"][1], pointData["point"][2]);
  535. osg::Vec3f normal = osg::Vec3f(pointData["normal"][0], pointData["normal"][1], pointData["normal"][2]);
  536. osg::Vec3f normalModifier = osg::Vec3f(pointData["normalModifier"][0], pointData["normalModifier"][1], pointData["normalModifier"][2]);
  537. OptiTrackPoint* optiTrackPoint = new OptiTrackPoint(point, normal, normalModifier, static_cast<float>(pointData["normalRotation"]), static_cast<bool>(pointData["compensation"]), static_cast<double>(pointData["length"]), static_cast<double>(pointData["radius"]));
  538. _optiTrackPoints.push_back(optiTrackPoint);
  539. }
  540. } catch (Lib3MF::ELib3MFException &e) {
  541. MainWindow::getInstance()->showErrorMessage("Unable to load OptiTrack trackpoints.", "Error opening project file.");
  542. }
  543. Lib3MF::PMetaData emfTrackString;
  544. try {
  545. emfTrackString = metaData->GetMetaDataByKey(META_NAMESPACE, "emftrack");
  546. auto emfTrackData = json::parse(emfTrackString->GetValue());
  547. _emfTrackPoints.clear();
  548. for (const auto pointData: emfTrackData) {
  549. osg::Vec3f point = osg::Vec3f(pointData["point"][0], pointData["point"][1], pointData["point"][2]);
  550. osg::Vec3f normal = osg::Vec3f(pointData["normal"][0], pointData["normal"][1], pointData["normal"][2]);
  551. osg::Vec3f normalModifier = osg::Vec3f(pointData["normalModifier"][0], pointData["normalModifier"][1], pointData["normalModifier"][2]);
  552. EMFTrackPoint* emfTrackPoint = new EMFTrackPoint(point, normal, normalModifier, static_cast<float>(pointData["normalRotation"]), static_cast<bool>(pointData["compensation"]), static_cast<double>(pointData["width"]), static_cast<double>(pointData["height"]), static_cast<double>(pointData["depth"]));
  553. _emfTrackPoints.push_back(emfTrackPoint);
  554. }
  555. } catch (Lib3MF::ELib3MFException &e) {
  556. MainWindow::getInstance()->showErrorMessage("Unable to load EMFTrack trackpoints.", "Error opening project file.");
  557. }
  558. Lib3MF::PMetaData steamVrTrackString;
  559. try {
  560. steamVrTrackString = metaData->GetMetaDataByKey(META_NAMESPACE, "steamvrtrack");
  561. auto steamVrData = json::parse(steamVrTrackString->GetValue());
  562. _steamVrTrackPoints.clear();
  563. for (const auto pointData: steamVrData) {
  564. osg::Vec3f point = osg::Vec3f(pointData["point"][0], pointData["point"][1], pointData["point"][2]);
  565. osg::Vec3f normal = osg::Vec3f(pointData["normal"][0], pointData["normal"][1], pointData["normal"][2]);
  566. osg::Vec3f normalModifier = osg::Vec3f(pointData["normalModifier"][0], pointData["normalModifier"][1], pointData["normalModifier"][2]);
  567. SteamVRTrackPoint* steamVrTrackPoint = new SteamVRTrackPoint(point, normal, normalModifier, static_cast<float>(pointData["normalRotation"]), static_cast<bool>(pointData["compensation"]), static_cast<double>(pointData["length"]));
  568. _steamVrTrackPoints.push_back(steamVrTrackPoint);
  569. }
  570. } catch (Lib3MF::ELib3MFException &e) {
  571. MainWindow::getInstance()->showErrorMessage("Unable to load SteamVR trackpoints.", "Error opening project file.");
  572. }
  573. Lib3MF::PMetaData actionPointString;
  574. try {
  575. actionPointString = metaData->GetMetaDataByKey(META_NAMESPACE, "actionpoints");
  576. auto actionPointData = json::parse(actionPointString->GetValue());
  577. _actionPoints.clear();
  578. for (const auto pointData: actionPointData) {
  579. osg::Vec3f point = osg::Vec3f(pointData["point"][0], pointData["point"][1], pointData["point"][2]);
  580. osg::Vec3f normal = osg::Vec3f(pointData["normal"][0], pointData["normal"][1], pointData["normal"][2]);
  581. osg::Vec3f normalModifier = osg::Vec3f(pointData["normalModifier"][0], pointData["normalModifier"][1], pointData["normalModifier"][2]);
  582. ActionPoint* actionPoint = new ActionPoint(point, normal, normalModifier, static_cast<float>(pointData["normalRotation"]), static_cast<bool>(pointData["compensation"]), pointData["identifier"]);
  583. _actionPoints.push_back(actionPoint);
  584. }
  585. } catch (Lib3MF::ELib3MFException &e) {
  586. MainWindow::getInstance()->showErrorMessage("Unable to load ActionPoints.", "Error opening project file.");
  587. }
  588. render3MFMesh();
  589. MainWindow::getInstance()->renderView(Edit);
  590. MainWindow::getInstance()->getOsgWidget()->getPointRenderer()->render(MainWindow::getInstance()->getEditWiget()->getSelectedTrackingSystem());
  591. MainWindow::getInstance()->getEditWiget()->updateTrackpointCount();
  592. }
  593. void ProjectStore::renderOptiTrackInThread(std::vector<OptiTrackPoint*> optiTrackPoints) {
  594. OpenScadRenderer* renderer = new OpenScadRenderer();
  595. renderer->renderOptiTrack(optiTrackPoints);
  596. delete renderer;
  597. }
  598. void ProjectStore::renderEMFTrackInThread(std::vector<EMFTrackPoint*> emfTrackPoints) {
  599. OpenScadRenderer* renderer = new OpenScadRenderer();
  600. renderer->renderEMFTrack(emfTrackPoints);
  601. delete renderer;
  602. }
  603. void ProjectStore::renderSteamVRTrackInThread(std::vector<SteamVRTrackPoint*> steamVrTrackPoints) {
  604. OpenScadRenderer* renderer = new OpenScadRenderer();
  605. renderer->renderSteamVRTrack(steamVrTrackPoints);
  606. delete renderer;
  607. }
  608. std::vector<float> ProjectStore::osgVecToStdVec(osg::Vec3f input) {
  609. std::vector<float> vector;
  610. vector.push_back(input.x());
  611. vector.push_back(input.y());
  612. vector.push_back(input.z());
  613. return vector;
  614. }
  615. osg::Vec3f ProjectStore::stdVecToOsgVec(std::vector<float> input) {
  616. return osg::Vec3f(input[0], input[1], input[2]);
  617. }