ptrc_one_sample_vis-3d.wls 2.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455
  1. #!/usr/bin/env wolframscript
  2. (* ::Package:: *)
  3. fileName="one_case_data-3d.txt";
  4. generateNewCase=1;
  5. Import["sample_data_parser.wl"]
  6. rangeX={Min[Table[dat[C][[i,1]]-dat[R][[i]],{i,1,dat[n]}]],
  7. Max[Table[dat[C][[i,1]]+dat[R][[i]],{i,1,dat[n]}]]};
  8. rangeY={Min[Table[dat[C][[i,2]]-dat[R][[i]],{i,1,dat[n]}]],
  9. Max[Table[dat[C][[i,2]]+dat[R][[i]],{i,1dat[n]}]]};
  10. rangeZ={Min[Table[dat[C][[i,3]]-dat[R][[i]],{i,1,dat[n]}]],
  11. Max[Table[dat[C][[i,3]]+dat[R][[i]],{i,1,dat[n]}]]};
  12. graphColors={Darker[Red],Darker[Green],Darker[Blue],Darker[Cyan],
  13. Darker[Magenta],Darker[Yellow],Darker[Brown],Darker[Orange],
  14. Darker[Pink],Darker[Purple],
  15. LightRed,LightGreen,LightBlue,LightCyan,LightMagenta,LightYellow,
  16. LightBrown,LightOrange,LightPink};
  17. centersGraph=Graphics3D[Table[{Thickness[Large],graphColors[[i]],
  18. Point[dat[C][[i]]]},{i,1,dat[n]}]];
  19. spheresGraph=Graphics3D[Table[{graphColors[[i]],Specularity[White,5],
  20. Opacity[0.33],Sphere[dat[C][[i]],dat[R][[i]]]},
  21. {i,1,dat[n]}]];
  22. routesGraphs=Table[Graphics3D[{Thickness[Medium],Black,
  23. Line[{Table[rts[[j]][[i]][P],
  24. {i,1,Length[rts[[j]]]}]}]
  25. }],{j,1,Length[rts]}];
  26. stFinGraphs=Table[Graphics3D[{
  27. {Thickness[Medium],Inset[Style["\[CircleTimes]",20],rts[[j,1]][P]]},
  28. {Thickness[Medium],Black,Inset[Style["\[CircleDot]",20],
  29. rts[[j,Length[rts[[j]]]]][P]]},
  30. {Thickness[Large],Black,Point[rts[[j,Length[rts[[j]]]]][P]]}
  31. }],{j,1,Length[rts]}];
  32. bestGuessGraph=Graphics3D[{Thickness[Large],Darker[Purple],Inset[Style["+",20],
  33. bestGuess[P]]}];
  34. bealPointGraph=Graphics3D[{Thickness[Large],Darker[Purple],Inset[Style["*",20],
  35. dat[realPoint]]}];
  36. "Maximum of sensors uncertainty: "<>ToString[dat[unc]]<>
  37. "; Final error: "<>ToString[dat[error]]
  38. Manipulate[
  39. Table[
  40. Show[centersGraph,
  41. Graphics3D[Table[{graphColors[[i]],Specularity[White,5],
  42. Opacity[opac],Sphere[dat[C][[i]],dat[R][[i]]]},
  43. {i,1,dat[n]}]],
  44. routesGraphs[[i]],stFinGraphs[[i]],bestGuessGraph,bealPointGraph],
  45. {i,1,Length[rts]}
  46. ],
  47. {{opac,0.5,"Opacity"},0,1, Appearance->"Labeled"}]