ProjectStore.cpp 27 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670
  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. reset();
  125. }
  126. bool ProjectStore::isModified() {
  127. return _projectModified;
  128. }
  129. bool ProjectStore::isRendering() {
  130. return _exportRunning;
  131. }
  132. void ProjectStore::projectModified() {
  133. _projectModified = true;
  134. }
  135. TrackPoint* ProjectStore::getTrackPointById(int id, ActiveTrackingSystem activeTrackingSystem) {
  136. switch(activeTrackingSystem) {
  137. case OptiTrack: {
  138. return _optiTrackPoints[id];
  139. };
  140. case EMFTrack: {
  141. return _emfTrackPoints[id];
  142. };
  143. case SteamVRTrack: {
  144. return _steamVrTrackPoints[id];
  145. };
  146. case ActionPoints: {
  147. return _actionPoints[id];
  148. };
  149. }
  150. }
  151. void ProjectStore::addTrackPoint(osg::Vec3 point, osg::Vec3 normal, ActiveTrackingSystem activeTrackingSystem) {
  152. switch(activeTrackingSystem) {
  153. case OptiTrack: {
  154. OptiTrackPoint* optiTrackPoint = new OptiTrackPoint(point, normal, _normalModifier, _normalRotation, _compensation, _optiTrackSettings.length, _optiTrackSettings.radius);
  155. _optiTrackPoints.push_back(optiTrackPoint);
  156. break;
  157. }
  158. case EMFTrack: {
  159. normal = normal.operator*(-1.0f);
  160. EMFTrackPoint* emfTrackPoint = new EMFTrackPoint(point, normal, _normalModifier, _normalRotation, _compensation, _emfTrackSettings.width, _emfTrackSettings.height, _emfTrackSettings.depth);
  161. _emfTrackPoints.push_back(emfTrackPoint);
  162. break;
  163. }
  164. case SteamVRTrack: {
  165. SteamVRTrackPoint* steamVrTrackPoint = new SteamVRTrackPoint(point, normal, _normalModifier, _normalRotation, _compensation, _steamVrTrackSettings.length);
  166. _steamVrTrackPoints.push_back(steamVrTrackPoint);
  167. break;
  168. }
  169. case ActionPoints: {
  170. ActionPoint* actionPoint = new ActionPoint(point, normal, _normalModifier, _normalRotation, _compensation, _actionPointSettings.identifier);
  171. _actionPoints.push_back(actionPoint);
  172. break;
  173. }
  174. }
  175. projectModified();
  176. MainWindow::getInstance()->getEditWiget()->updateTrackpointCount();
  177. }
  178. int ProjectStore::getCount(ActiveTrackingSystem activeTrackingSystem) {
  179. switch(activeTrackingSystem) {
  180. case OptiTrack: {
  181. return _optiTrackPoints.size();
  182. };
  183. case EMFTrack: {
  184. return _emfTrackPoints.size();
  185. };
  186. case SteamVRTrack: {
  187. return _steamVrTrackPoints.size();
  188. };
  189. case ActionPoints: {
  190. return _actionPoints.size();
  191. };
  192. }
  193. }
  194. void ProjectStore::removeTrackPoint(int id, ActiveTrackingSystem activeTrackingSystem) {
  195. switch(activeTrackingSystem) {
  196. case OptiTrack: {
  197. _optiTrackPoints.erase(_optiTrackPoints.begin() + id);
  198. break;
  199. }
  200. case EMFTrack: {
  201. _emfTrackPoints.erase(_emfTrackPoints.begin() + id);
  202. break;
  203. }
  204. case SteamVRTrack: {
  205. _steamVrTrackPoints.erase(_steamVrTrackPoints.begin() + id);
  206. break;
  207. }
  208. case ActionPoints: {
  209. _actionPoints.erase(_actionPoints.begin() + id);
  210. break;
  211. }
  212. }
  213. projectModified();
  214. MainWindow::getInstance()->getEditWiget()->updateTrackpointCount();
  215. }
  216. void ProjectStore::updateNormalModifier(osg::Vec3 modifier) {
  217. _normalModifier = modifier;
  218. }
  219. osg::Vec3 ProjectStore::getNormalModifier() {
  220. return _normalModifier;
  221. }
  222. void ProjectStore::updateNormalRotation(float normalRotation) {
  223. _normalRotation = normalRotation;
  224. }
  225. float ProjectStore::getNormalRotation() {
  226. return _normalRotation;
  227. }
  228. void ProjectStore::updateCompensation(bool compensation) {
  229. _compensation = compensation;
  230. }
  231. bool ProjectStore::getCompensation() {
  232. return _compensation;
  233. }
  234. std::vector<OptiTrackPoint*> ProjectStore::getOptiTrackPoints() {
  235. return _optiTrackPoints;
  236. }
  237. void ProjectStore::updateOptiTrackSettings(OptiTrackSettings optiTrackSettings) {
  238. _optiTrackSettings = optiTrackSettings;
  239. }
  240. OptiTrackSettings ProjectStore::getOptiTrackSettings() {
  241. return _optiTrackSettings;
  242. }
  243. std::vector<EMFTrackPoint*> ProjectStore::getEMFTrackPoints() {
  244. return _emfTrackPoints;
  245. }
  246. void ProjectStore::updateEMFTrackSettings(EMFTrackSettings emfTrackSettings) {
  247. _emfTrackSettings = emfTrackSettings;
  248. }
  249. EMFTrackSettings ProjectStore::getEMFTrackSettings() {
  250. return _emfTrackSettings;
  251. }
  252. std::vector<SteamVRTrackPoint*> ProjectStore::getSteamVRTrackPoints() {
  253. return _steamVrTrackPoints;
  254. }
  255. void ProjectStore::updateSteamVRTrackSettings(SteamVRTrackSettings steamVrTrackSettings) {
  256. _steamVrTrackSettings = steamVrTrackSettings;
  257. }
  258. SteamVRTrackSettings ProjectStore::getSteamVRTrackSettings() {
  259. return _steamVrTrackSettings;
  260. }
  261. std::vector<ActionPoint*> ProjectStore::getActionPoints() {
  262. return _actionPoints;
  263. }
  264. void ProjectStore::updateActionPointSettings(ActionPointSettings actionPointSettings) {
  265. _actionPointSettings = actionPointSettings;
  266. }
  267. ActionPointSettings ProjectStore::getActionPointSettings() {
  268. return _actionPointSettings;
  269. }
  270. unsigned int ProjectStore::actionPointIdentifierInUse(std::string candidate, int current) {
  271. unsigned int count = 0;
  272. int i = 0;
  273. for (ActionPoint* actionPoint: _actionPoints) {
  274. if (i != current && candidate.compare(actionPoint->getIdentifier()) == 0) {
  275. count++;
  276. }
  277. i++;
  278. }
  279. return count;
  280. }
  281. void ProjectStore::renderThreadDone() {
  282. _doneExports++;
  283. MainWindow::getInstance()->getEditWiget()->setExportStatus(_wantedExports, _doneExports);
  284. if (_wantedExports == _doneExports) {
  285. // Export file
  286. Lib3MF::PModel exportModel = _wrapper->CreateModel();
  287. Lib3MF::PMetaDataGroup metaData = exportModel->GetMetaDataGroup();
  288. if (_currentExportSettings.OptiTrack) {
  289. Lib3MF::PModel optiTrackModel = _wrapper->CreateModel();
  290. Lib3MF::PReader reader = optiTrackModel->QueryReader("3mf");
  291. reader->ReadFromFile(std::filesystem::temp_directory_path().u8string() + fileDelimiter + "trackpointapp_render_optitrack.3mf");
  292. Lib3MF::PMeshObjectIterator meshIterator = optiTrackModel->GetMeshObjects();
  293. if (meshIterator->Count() == 1) {
  294. meshIterator->MoveNext();
  295. Lib3MF::PMeshObject renderedMesh = meshIterator->GetCurrentMeshObject();
  296. Lib3MF::PMeshObject exportMesh = exportModel->AddMeshObject();
  297. exportMesh->SetName("optitrack");
  298. std::vector<Lib3MF::sPosition> verticesBuffer;
  299. std::vector<Lib3MF::sTriangle> triangleBuffer;
  300. renderedMesh->GetVertices(verticesBuffer);
  301. renderedMesh->GetTriangleIndices(triangleBuffer);
  302. exportMesh->SetGeometry(verticesBuffer, triangleBuffer);
  303. json trackpointData = json::array();
  304. for (OptiTrackPoint* point: _optiTrackPoints) {
  305. osg::Vec3 trackPoint = point->getTrackPoint();
  306. osg::Vec3 trackNormal = point->getNormal();
  307. json pointData = {
  308. {"point", {trackPoint.x(), trackPoint.y(), trackPoint.z()}},
  309. {"normal", {trackNormal.x(), trackNormal.y(), trackNormal.z()}}
  310. };
  311. trackpointData.push_back(pointData);
  312. }
  313. Lib3MF::PMetaDataGroup optiMetaData = exportMesh->GetMetaDataGroup();
  314. optiMetaData->AddMetaData(META_NAMESPACE, "trackpoints-optitrack", trackpointData.dump(), "string", true);
  315. exportModel->AddBuildItem(exportMesh.get(), _wrapper->GetIdentityTransform());
  316. } else {
  317. MainWindow::getInstance()->showErrorMessage("An error occured while rendering OptiTrack model: inconsistent data.", "Error exporting project.");
  318. }
  319. }
  320. if (_currentExportSettings.EMFTrack) {
  321. Lib3MF::PModel emfTrackModel = _wrapper->CreateModel();
  322. Lib3MF::PReader reader = emfTrackModel->QueryReader("3mf");
  323. reader->ReadFromFile(std::filesystem::temp_directory_path().u8string() + fileDelimiter + "trackpointapp_render_emftrack.3mf");
  324. Lib3MF::PMeshObjectIterator meshIterator = emfTrackModel->GetMeshObjects();
  325. if (meshIterator->Count() == 1) {
  326. meshIterator->MoveNext();
  327. Lib3MF::PMeshObject renderedMesh = meshIterator->GetCurrentMeshObject();
  328. Lib3MF::PMeshObject exportMesh = exportModel->AddMeshObject();
  329. exportMesh->SetName("emftrack");
  330. std::vector<Lib3MF::sPosition> verticesBuffer;
  331. std::vector<Lib3MF::sTriangle> triangleBuffer;
  332. renderedMesh->GetVertices(verticesBuffer);
  333. renderedMesh->GetTriangleIndices(triangleBuffer);
  334. exportMesh->SetGeometry(verticesBuffer, triangleBuffer);
  335. json trackpointData = json::array();
  336. for (EMFTrackPoint* point: _emfTrackPoints) {
  337. osg::Vec3 moveToMid = point->getNormal().operator*(-(point->getDepth() / 2));
  338. osg::Vec3 trackPoint = point->getTrackPoint().operator+(moveToMid);
  339. osg::Vec3 trackNormal = point->getNormal();
  340. json pointData = {
  341. {"point", {trackPoint.x(), trackPoint.y(), trackPoint.z()}},
  342. {"normal", {trackNormal.x(), trackNormal.y(), trackNormal.z()}},
  343. {"rotation", point->getNormalRotation()}
  344. };
  345. trackpointData.push_back(pointData);
  346. }
  347. Lib3MF::PMetaDataGroup emfMetaData = exportMesh->GetMetaDataGroup();
  348. emfMetaData->AddMetaData(META_NAMESPACE, "trackpoints-emftrack", trackpointData.dump(), "string", true);
  349. exportModel->AddBuildItem(exportMesh.get(), _wrapper->GetIdentityTransform());
  350. } else {
  351. MainWindow::getInstance()->showErrorMessage("An error occured while rendering EMFTrack model: inconsistent data.", "Error exporting project.");
  352. }
  353. }
  354. if (_currentExportSettings.SteamVRTrack) {
  355. Lib3MF::PModel steamVrTrackModel = _wrapper->CreateModel();
  356. Lib3MF::PReader reader = steamVrTrackModel->QueryReader("3mf");
  357. reader->ReadFromFile(std::filesystem::temp_directory_path().u8string() + fileDelimiter + "trackpointapp_render_steamvrtrack.3mf");
  358. Lib3MF::PMeshObjectIterator meshIterator = steamVrTrackModel->GetMeshObjects();
  359. if (meshIterator->Count() == 1) {
  360. meshIterator->MoveNext();
  361. Lib3MF::PMeshObject renderedMesh = meshIterator->GetCurrentMeshObject();
  362. Lib3MF::PMeshObject exportMesh = exportModel->AddMeshObject();
  363. exportMesh->SetName("steamvrtrack");
  364. std::vector<Lib3MF::sPosition> verticesBuffer;
  365. std::vector<Lib3MF::sTriangle> triangleBuffer;
  366. renderedMesh->GetVertices(verticesBuffer);
  367. renderedMesh->GetTriangleIndices(triangleBuffer);
  368. exportMesh->SetGeometry(verticesBuffer, triangleBuffer);
  369. json trackpointData = json::array();
  370. for (SteamVRTrackPoint* point: _steamVrTrackPoints) {
  371. osg::Vec3 trackPoint = point->getTrackPoint();
  372. osg::Vec3 trackNormal = point->getNormal();
  373. json pointData = {
  374. {"point", {trackPoint.x(), trackPoint.y(), trackPoint.z()}},
  375. {"normal", {trackNormal.x(), trackNormal.y(), trackNormal.z()}}
  376. };
  377. trackpointData.push_back(pointData);
  378. }
  379. Lib3MF::PMetaDataGroup steamVrMetaData = exportMesh->GetMetaDataGroup();
  380. steamVrMetaData->AddMetaData(META_NAMESPACE, "trackpoints-steamvrtrack", trackpointData.dump(), "string", true);
  381. exportModel->AddBuildItem(exportMesh.get(), _wrapper->GetIdentityTransform());
  382. } else {
  383. MainWindow::getInstance()->showErrorMessage("An error occured while rendering SteamVR Track model: inconsistent data.", "Error exporting project.");
  384. }
  385. }
  386. // Export action point metadata
  387. json actionPointData;
  388. for (ActionPoint* point: _actionPoints) {
  389. osg::Vec3 translation = point->getTranslation();
  390. osg::Vec3 normal = point->getNormal();
  391. actionPointData[point->getIdentifier()] = {
  392. {"point", {translation.x(), translation.y(), translation.z()}},
  393. {"normal", {normal.x(), normal.y(), normal.z()}}
  394. };
  395. }
  396. metaData->AddMetaData(META_NAMESPACE, "trackpoints-actionpoints", actionPointData.dump(), "string", true);
  397. Lib3MF::PWriter exportWriter = exportModel->QueryWriter("3mf");
  398. exportWriter->WriteToFile(_exportPath);
  399. _exportRunning = false;
  400. MainWindow::getInstance()->getEditWiget()->setExportAvailable(true);
  401. }
  402. }
  403. void ProjectStore::load3mfLib() {
  404. _wrapper = Lib3MF::CWrapper::loadLibrary();
  405. _project = _wrapper->CreateModel();
  406. }
  407. void ProjectStore::reset() {
  408. _project = _wrapper->CreateModel();
  409. _optiTrackPoints.clear();
  410. _steamVrTrackPoints.clear();
  411. _actionPoints.clear();
  412. _optiTrackSettings = OptiTrackSettings {OPTITRACK_DEFAULT_LENGTH, OPTITRACK_DEFAULT_RADIUS};
  413. _steamVrTrackSettings = SteamVRTrackSettings {STEAMVR_DEFAULT_LENGTH};
  414. _actionPointSettings = ActionPointSettings {ACTIONPOINT_DEFAULT_IDENFIFIER};
  415. _normalModifier = osg::Vec3(0.0f, 0.0f, 0.0f);
  416. }
  417. void ProjectStore::render3MFMesh() {
  418. // Get meshes
  419. Lib3MF::PMeshObjectIterator meshIterator = _project->GetMeshObjects();
  420. // Our use case supports just a single mesh per project
  421. if (meshIterator->Count() != 1) {
  422. 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.");
  423. }
  424. meshIterator->MoveNext();
  425. Lib3MF::PMeshObject mesh = meshIterator->GetCurrentMeshObject();
  426. // Load vertices and triangles and render them
  427. std::vector<Lib3MF::sPosition> verticesBuffer;
  428. mesh->GetVertices(verticesBuffer);
  429. std::vector<Lib3MF::sTriangle> triangleBuffer;
  430. mesh->GetTriangleIndices(triangleBuffer);
  431. // Create osg style arrays
  432. osg::ref_ptr<osg::Vec3Array> vertices = new osg::Vec3Array;
  433. osg::ref_ptr<osg::Vec3Array> normals = new osg::Vec3Array;
  434. // Convert data to osg format and calculate vertex normals
  435. MeshTools::calculateNormals(verticesBuffer, triangleBuffer, vertices, normals);
  436. // Call renderer
  437. MainWindow* mainWindow = MainWindow::getInstance();
  438. mainWindow->getOsgWidget()->renderBaseMesh(vertices, normals);
  439. }
  440. void ProjectStore::updateMetaData() {
  441. Lib3MF::PMetaDataGroup metaData = _project->GetMetaDataGroup();
  442. try {
  443. Lib3MF::PMetaData versionInformation = metaData->GetMetaDataByKey(META_NAMESPACE, "format");
  444. } catch (Lib3MF::ELib3MFException &e) {
  445. metaData->AddMetaData(META_NAMESPACE, "format", "1.0.0", "string", true);
  446. }
  447. json optiTrackData = json::array();
  448. for (OptiTrackPoint* optiTrackPoint: _optiTrackPoints) {
  449. optiTrackData.push_back({
  450. {"point", osgVecToStdVec(optiTrackPoint->getTranslation())},
  451. {"normal", osgVecToStdVec(optiTrackPoint->getNormal())},
  452. {"normalModifier", osgVecToStdVec(optiTrackPoint->getNormalModifier())},
  453. {"normalRotation", optiTrackPoint->getNormalRotation()},
  454. {"compensation", optiTrackPoint->getCompensation()},
  455. {"length", optiTrackPoint->getLength()},
  456. {"radius", optiTrackPoint->getRadius()}
  457. });
  458. }
  459. try {
  460. Lib3MF::PMetaData optiTrackPoints = metaData->GetMetaDataByKey(META_NAMESPACE, "optitrack");
  461. optiTrackPoints->SetValue(optiTrackData.dump());
  462. } catch (Lib3MF::ELib3MFException &e) {
  463. metaData->AddMetaData(META_NAMESPACE, "optitrack", optiTrackData.dump(), "string", true);
  464. }
  465. json emfTrackData = json::array();
  466. for (EMFTrackPoint* emfTrackPoint: _emfTrackPoints) {
  467. emfTrackData.push_back({
  468. {"point", osgVecToStdVec(emfTrackPoint->getTranslation())},
  469. {"normal", osgVecToStdVec(emfTrackPoint->getNormal())},
  470. {"normalModifier", osgVecToStdVec(emfTrackPoint->getNormalModifier())},
  471. {"normalRotation", emfTrackPoint->getNormalRotation()},
  472. {"compensation", emfTrackPoint->getCompensation()},
  473. {"width", emfTrackPoint->getWidth()},
  474. {"height", emfTrackPoint->getHeight()},
  475. {"depth", emfTrackPoint->getDepth()}
  476. });
  477. }
  478. try {
  479. Lib3MF::PMetaData emfTrackPoints = metaData->GetMetaDataByKey(META_NAMESPACE, "emftrack");
  480. emfTrackPoints->SetValue(emfTrackData.dump());
  481. } catch (Lib3MF::ELib3MFException &e) {
  482. metaData->AddMetaData(META_NAMESPACE, "emftrack", emfTrackData.dump(), "string", true);
  483. }
  484. json steamVrTrackData = json::array();
  485. for (SteamVRTrackPoint* steamVrTrackPoint: _steamVrTrackPoints) {
  486. steamVrTrackData.push_back({
  487. {"point", osgVecToStdVec(steamVrTrackPoint->getTranslation())},
  488. {"normal", osgVecToStdVec(steamVrTrackPoint->getNormal())},
  489. {"normalModifier", osgVecToStdVec(steamVrTrackPoint->getNormalModifier())},
  490. {"normalRotation", steamVrTrackPoint->getNormalRotation()},
  491. {"compensation", steamVrTrackPoint->getCompensation()},
  492. {"length", steamVrTrackPoint->getLength()}
  493. });
  494. }
  495. try {
  496. Lib3MF::PMetaData steamVrTrackPoints = metaData->GetMetaDataByKey(META_NAMESPACE, "steamvrtrack");
  497. steamVrTrackPoints->SetValue(steamVrTrackData.dump());
  498. } catch (Lib3MF::ELib3MFException &e) {
  499. metaData->AddMetaData(META_NAMESPACE, "steamvrtrack", steamVrTrackData.dump(), "string", true);
  500. }
  501. json actionPointData = json::array();
  502. for (ActionPoint* actionPoint: _actionPoints) {
  503. actionPointData.push_back({
  504. {"point", osgVecToStdVec(actionPoint->getTranslation())},
  505. {"normal", osgVecToStdVec(actionPoint->getNormal())},
  506. {"normalModifier", osgVecToStdVec(actionPoint->getNormalModifier())},
  507. {"normalRotation", actionPoint->getNormalRotation()},
  508. {"compensation", actionPoint->getCompensation()},
  509. {"identifier", actionPoint->getIdentifier()}
  510. });
  511. }
  512. try {
  513. Lib3MF::PMetaData actionPoints = metaData->GetMetaDataByKey(META_NAMESPACE, "actionpoints");
  514. actionPoints->SetValue(actionPointData.dump());
  515. } catch (Lib3MF::ELib3MFException &e) {
  516. metaData->AddMetaData(META_NAMESPACE, "actionpoints", actionPointData.dump(), "string", true);
  517. }
  518. }
  519. void ProjectStore::loadMetaData() {
  520. Lib3MF::PMetaDataGroup metaData = _project->GetMetaDataGroup();
  521. try {
  522. Lib3MF::PMetaData versionInformation = metaData->GetMetaDataByKey(META_NAMESPACE, "format");
  523. } catch (Lib3MF::ELib3MFException &e) {
  524. MainWindow::getInstance()->showErrorMessage("This is not a valid TrackpointApp project.", "Error opening project file.");
  525. }
  526. Lib3MF::PMetaData optiTrackString;
  527. try {
  528. optiTrackString = metaData->GetMetaDataByKey(META_NAMESPACE, "optitrack");
  529. auto optiTrackData = json::parse(optiTrackString->GetValue());
  530. _optiTrackPoints.clear();
  531. for (const auto pointData: optiTrackData) {
  532. osg::Vec3f point = osg::Vec3f(pointData["point"][0], pointData["point"][1], pointData["point"][2]);
  533. osg::Vec3f normal = osg::Vec3f(pointData["normal"][0], pointData["normal"][1], pointData["normal"][2]);
  534. osg::Vec3f normalModifier = osg::Vec3f(pointData["normalModifier"][0], pointData["normalModifier"][1], pointData["normalModifier"][2]);
  535. 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"]));
  536. _optiTrackPoints.push_back(optiTrackPoint);
  537. }
  538. } catch (Lib3MF::ELib3MFException &e) {
  539. MainWindow::getInstance()->showErrorMessage("Unable to load OptiTrack trackpoints.", "Error opening project file.");
  540. }
  541. Lib3MF::PMetaData emfTrackString;
  542. try {
  543. emfTrackString = metaData->GetMetaDataByKey(META_NAMESPACE, "emftrack");
  544. auto emfTrackData = json::parse(emfTrackString->GetValue());
  545. _emfTrackPoints.clear();
  546. for (const auto pointData: emfTrackData) {
  547. osg::Vec3f point = osg::Vec3f(pointData["point"][0], pointData["point"][1], pointData["point"][2]);
  548. osg::Vec3f normal = osg::Vec3f(pointData["normal"][0], pointData["normal"][1], pointData["normal"][2]);
  549. osg::Vec3f normalModifier = osg::Vec3f(pointData["normalModifier"][0], pointData["normalModifier"][1], pointData["normalModifier"][2]);
  550. 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"]));
  551. _emfTrackPoints.push_back(emfTrackPoint);
  552. }
  553. } catch (Lib3MF::ELib3MFException &e) {
  554. MainWindow::getInstance()->showErrorMessage("Unable to load EMFTrack trackpoints.", "Error opening project file.");
  555. }
  556. Lib3MF::PMetaData steamVrTrackString;
  557. try {
  558. steamVrTrackString = metaData->GetMetaDataByKey(META_NAMESPACE, "steamvrtrack");
  559. auto steamVrData = json::parse(steamVrTrackString->GetValue());
  560. _steamVrTrackPoints.clear();
  561. for (const auto pointData: steamVrData) {
  562. osg::Vec3f point = osg::Vec3f(pointData["point"][0], pointData["point"][1], pointData["point"][2]);
  563. osg::Vec3f normal = osg::Vec3f(pointData["normal"][0], pointData["normal"][1], pointData["normal"][2]);
  564. osg::Vec3f normalModifier = osg::Vec3f(pointData["normalModifier"][0], pointData["normalModifier"][1], pointData["normalModifier"][2]);
  565. SteamVRTrackPoint* steamVrTrackPoint = new SteamVRTrackPoint(point, normal, normalModifier, static_cast<float>(pointData["normalRotation"]), static_cast<bool>(pointData["compensation"]), static_cast<double>(pointData["length"]));
  566. _steamVrTrackPoints.push_back(steamVrTrackPoint);
  567. }
  568. } catch (Lib3MF::ELib3MFException &e) {
  569. MainWindow::getInstance()->showErrorMessage("Unable to load SteamVR trackpoints.", "Error opening project file.");
  570. }
  571. Lib3MF::PMetaData actionPointString;
  572. try {
  573. actionPointString = metaData->GetMetaDataByKey(META_NAMESPACE, "actionpoints");
  574. auto actionPointData = json::parse(actionPointString->GetValue());
  575. _actionPoints.clear();
  576. for (const auto pointData: actionPointData) {
  577. osg::Vec3f point = osg::Vec3f(pointData["point"][0], pointData["point"][1], pointData["point"][2]);
  578. osg::Vec3f normal = osg::Vec3f(pointData["normal"][0], pointData["normal"][1], pointData["normal"][2]);
  579. osg::Vec3f normalModifier = osg::Vec3f(pointData["normalModifier"][0], pointData["normalModifier"][1], pointData["normalModifier"][2]);
  580. ActionPoint* actionPoint = new ActionPoint(point, normal, normalModifier, static_cast<float>(pointData["normalRotation"]), static_cast<bool>(pointData["compensation"]), pointData["identifier"]);
  581. _actionPoints.push_back(actionPoint);
  582. }
  583. } catch (Lib3MF::ELib3MFException &e) {
  584. MainWindow::getInstance()->showErrorMessage("Unable to load ActionPoints.", "Error opening project file.");
  585. }
  586. render3MFMesh();
  587. MainWindow::getInstance()->renderView(Edit);
  588. MainWindow::getInstance()->getOsgWidget()->getPointRenderer()->render(MainWindow::getInstance()->getEditWiget()->getSelectedTrackingSystem());
  589. MainWindow::getInstance()->getEditWiget()->updateTrackpointCount();
  590. }
  591. void ProjectStore::renderOptiTrackInThread(std::vector<OptiTrackPoint*> optiTrackPoints) {
  592. OpenScadRenderer* renderer = new OpenScadRenderer();
  593. renderer->renderOptiTrack(optiTrackPoints);
  594. delete renderer;
  595. }
  596. void ProjectStore::renderEMFTrackInThread(std::vector<EMFTrackPoint*> emfTrackPoints) {
  597. OpenScadRenderer* renderer = new OpenScadRenderer();
  598. renderer->renderEMFTrack(emfTrackPoints);
  599. delete renderer;
  600. }
  601. void ProjectStore::renderSteamVRTrackInThread(std::vector<SteamVRTrackPoint*> steamVrTrackPoints) {
  602. OpenScadRenderer* renderer = new OpenScadRenderer();
  603. renderer->renderSteamVRTrack(steamVrTrackPoints);
  604. delete renderer;
  605. }
  606. std::vector<float> ProjectStore::osgVecToStdVec(osg::Vec3f input) {
  607. std::vector<float> vector;
  608. vector.push_back(input.x());
  609. vector.push_back(input.y());
  610. vector.push_back(input.z());
  611. return vector;
  612. }
  613. osg::Vec3f ProjectStore::stdVecToOsgVec(std::vector<float> input) {
  614. return osg::Vec3f(input[0], input[1], input[2]);
  615. }