MVP_Model.cs 28 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706
  1. using System;
  2. using System.Collections.Generic;
  3. using System.Windows;
  4. using System.Linq;
  5. using System.Text;
  6. using System.Threading.Tasks;
  7. using System.Windows.Controls;
  8. using System.Windows.Media;
  9. using System.Windows.Media.Imaging;
  10. using OptiTrack;
  11. using System.Runtime.InteropServices;
  12. using System.IO;
  13. namespace SketchAssistantWPF
  14. {
  15. public class MVP_Model
  16. {
  17. /// <summary>
  18. /// The Presenter of the MVP-Model.
  19. /// </summary>
  20. MVP_Presenter programPresenter;
  21. /// <summary>
  22. /// History of Actions
  23. /// </summary>
  24. ActionHistory historyOfActions;
  25. /// <summary>
  26. /// The assistant responsible for the redraw mode
  27. /// </summary>
  28. OptiTrackConnector connector;
  29. /***********************/
  30. /*** CLASS VARIABLES ***/
  31. /***********************/
  32. /// <summary>
  33. /// If the program is in drawing mode.
  34. /// </summary>
  35. public bool inDrawingMode { get; private set; }
  36. /// <summary>
  37. /// if the program is using OptiTrack
  38. /// </summary>
  39. public bool optiTrackInUse { get; private set; }
  40. /// <summary>
  41. /// Size of deletion area
  42. /// </summary>
  43. int deletionRadius = 5;
  44. /// <summary>
  45. /// The Position of the Cursor in the right picture box
  46. /// </summary>
  47. Point currentCursorPosition;
  48. /// <summary>
  49. /// The Previous Cursor Position in the right picture box
  50. /// </summary>
  51. Point previousCursorPosition;
  52. /// <summary>
  53. /// Queue for the cursorPositions
  54. /// </summary>
  55. Queue<Point> cursorPositions = new Queue<Point>();
  56. /// <summary>
  57. /// The Position of the Cursor of opti track
  58. /// </summary>
  59. Point currentOptiCursorPosition;
  60. /// <summary>
  61. /// The Previous Cursor Position of opti track
  62. /// </summary>
  63. Point previousOptiCursorPosition;
  64. /// <summary>
  65. /// Queue for the cursorPositions of opti track
  66. /// </summary>
  67. Queue<Point> optiCursorPositions = new Queue<Point>();
  68. /// <summary>
  69. /// Lookup Matrix for checking postions of lines in the image
  70. /// </summary>
  71. bool[,] isFilledMatrix;
  72. /// <summary>
  73. /// Lookup Matrix for getting line ids at a certain postions of the image
  74. /// </summary>
  75. HashSet<int>[,] linesMatrix;
  76. /// <summary>
  77. /// Width of the LeftImageBox.
  78. /// </summary>
  79. public int leftImageBoxWidth;
  80. /// <summary>
  81. /// Height of the LeftImageBox.
  82. /// </summary>
  83. public int leftImageBoxHeight;
  84. /// <summary>
  85. /// Width of the RightImageBox.
  86. /// </summary>
  87. public int rightImageBoxWidth;
  88. /// <summary>
  89. /// Height of the RightImageBox.
  90. /// </summary>
  91. public int rightImageBoxHeight;
  92. public ImageDimension leftImageSize { get; private set; }
  93. public ImageDimension rightImageSize { get; private set; }
  94. /// <summary>
  95. /// Indicates whether or not the canvas on the right side is active.
  96. /// </summary>
  97. public bool canvasActive { get; set; }
  98. /// <summary>
  99. /// Indicates if there is a graphic loaded in the left canvas.
  100. /// </summary>
  101. public bool graphicLoaded { get; set; }
  102. /// <summary>
  103. /// Whether or not an optitrack system is avaiable.
  104. /// </summary>
  105. public bool optitrackAvailable { get; private set; }
  106. /// <summary>
  107. /// x coordinate in real world. one unit is one meter. If standing in front of video wall facing it, moving left results in incrementation of x.
  108. /// </summary>
  109. public float optiTrackX;
  110. /// <summary>
  111. /// y coordinate in real world. one unit is one meter. If standing in front of video wall, moving up results in incrementation of y.
  112. /// </summary>
  113. public float optiTrackY;
  114. /// <summary>
  115. /// z coordinate in real world. one unit is one meter. If standing in front of video wall, moving back results in incrementation of y.
  116. /// </summary>
  117. public float optiTrackZ;
  118. /// <summary>
  119. /// keeps track of whether last tick the trackable was inside drawing zone or not.
  120. /// </summary>
  121. private bool optiTrackInsideDrawingZone = false;
  122. /// <summary>
  123. /// this is a variable used for detecting whether the tracker is in the warning zone (0 +- variable), no drawing zone (0 +- 2 * variable) or normal drawing zone
  124. /// </summary>
  125. private double WARNING_ZONE_BOUNDARY = 0.10; //10cm
  126. /// <summary>
  127. /// object of class Armband used for controlling the vibrotactil armband
  128. /// </summary>
  129. private Armband armband;
  130. /// <summary>
  131. /// deactivates all Console.WriteLine() when set to false
  132. /// </summary>
  133. bool testing = false;//TODO: remove after finishing userstory
  134. /// <summary>
  135. /// Is set to true when the trackable has passed to the backside of the drawing surface,
  136. /// invalidating all inputs on its way back.
  137. /// </summary>
  138. bool OptiMovingBack = false;
  139. /// <summary>
  140. /// The Layer in which the optitrack system was. 0 is drawing layer, -1 is in front, 1 is behind
  141. /// </summary>
  142. int OptiLayer = 0;
  143. /// <summary>
  144. /// Whether or not the mouse is pressed.
  145. /// </summary>
  146. private bool mouseDown;
  147. List<InternalLine> leftLineList;
  148. List<Tuple<bool, InternalLine>> rightLineList;
  149. List<Point> currentLine = new List<Point>();
  150. public MVP_Model(MVP_Presenter presenter)
  151. {
  152. programPresenter = presenter;
  153. historyOfActions = new ActionHistory();
  154. //redrawAss = new RedrawAssistant();
  155. //overlayItems = new List<Tuple<bool, HashSet<Point>>>();
  156. rightLineList = new List<Tuple<bool, InternalLine>>();
  157. canvasActive = false;
  158. UpdateUI();
  159. rightImageSize = new ImageDimension(0, 0);
  160. leftImageSize = new ImageDimension(0, 0);
  161. connector = new OptiTrackConnector();
  162. armband = new Armband();
  163. optitrackAvailable = false;
  164. if (File.Exists(@"C:\Users\videowall-pc-user\Documents\BP-SketchAssistant\SketchAssistant\optitrack_setup.ttp"))
  165. {
  166. if (connector.Init(@"C:\Users\videowall-pc-user\Documents\BP-SketchAssistant\SketchAssistant\optitrack_setup.ttp"))
  167. {
  168. optitrackAvailable = true;
  169. connector.StartTracking(getOptiTrackPosition);
  170. }
  171. }
  172. }
  173. [DllImport("user32.dll", EntryPoint = "SetCursorPos")]
  174. private static extern bool SetCursorPos(int X, int Y);
  175. //[DllImport("user32.dll")]
  176. //public static extern void mouse_event(int dwFlags, int dx, int dy, int cButtons, int dwExtraInfo);
  177. public enum MouseEventType : int
  178. {
  179. LeftDown = 0x02,
  180. LeftUp = 0x04,
  181. RightDown = 0x08,
  182. RightUp = 0x10
  183. }
  184. /**************************/
  185. /*** INTERNAL FUNCTIONS ***/
  186. /**************************/
  187. /// <summary>
  188. /// Change the status of whether or not the lines are shown.
  189. /// </summary>
  190. /// <param name="lines">The HashSet containing the affected Line IDs.</param>
  191. /// <param name="shown">True if the lines should be shown, false if they should be hidden.</param>
  192. private void ChangeLines(HashSet<int> lines, bool shown)
  193. {
  194. foreach (int lineId in lines)
  195. {
  196. if (lineId <= rightLineList.Count - 1 && lineId >= 0)
  197. {
  198. rightLineList[lineId] = new Tuple<bool, InternalLine>(shown, rightLineList[lineId].Item2);
  199. }
  200. }
  201. }
  202. /// <summary>
  203. /// A function that populates the matrixes needed for deletion detection with line data.
  204. /// </summary>
  205. private void RepopulateDeletionMatrixes()
  206. {
  207. if (canvasActive)
  208. {
  209. isFilledMatrix = new bool[rightImageSize.Width, rightImageSize.Height];
  210. linesMatrix = new HashSet<int>[rightImageSize.Width, rightImageSize.Height];
  211. foreach (Tuple<bool, InternalLine> lineTuple in rightLineList)
  212. {
  213. if (lineTuple.Item1)
  214. {
  215. lineTuple.Item2.PopulateMatrixes(isFilledMatrix, linesMatrix);
  216. }
  217. }
  218. }
  219. }
  220. /// <summary>
  221. /// Tells the Presenter to Update the UI
  222. /// </summary>
  223. private void UpdateUI()
  224. {
  225. programPresenter.UpdateUIState(inDrawingMode, historyOfActions.CanUndo(), historyOfActions.CanRedo(), canvasActive, graphicLoaded, optitrackAvailable, optiTrackInUse);
  226. }
  227. /// <summary>
  228. /// A function that checks the deletion matrixes at a certain point
  229. /// and returns all Line ids at that point and in a square around it in a certain range.
  230. /// </summary>
  231. /// <param name="p">The point around which to check.</param>
  232. /// <param name="range">The range around the point. If range is 0, only the point is checked.</param>
  233. /// <returns>A List of all lines.</returns>
  234. private HashSet<int> CheckDeletionMatrixesAroundPoint(Point p, int range)
  235. {
  236. HashSet<int> returnSet = new HashSet<int>();
  237. foreach (Point pnt in GeometryCalculator.FilledCircleAlgorithm(p, (int)range))
  238. {
  239. if (pnt.X >= 0 && pnt.Y >= 0 && pnt.X < rightImageSize.Width && pnt.Y < rightImageSize.Height)
  240. {
  241. if (isFilledMatrix[(int)pnt.X, (int)pnt.Y])
  242. {
  243. returnSet.UnionWith(linesMatrix[(int)pnt.X, (int)pnt.Y]);
  244. }
  245. }
  246. }
  247. return returnSet;
  248. }
  249. //TODO: calibrate
  250. double OPTITRACK_X_OFFSET = -0.4854;
  251. double OPTITRACK_Y_OFFSET = 0.9;
  252. double OPTITRACK_CANVAS_HEIGHT = 1.2;
  253. double OPTITRACK_X_SCALE = 0.21 * (((1.8316/*size of canvis*/ / 0.0254) * 96) / (1.8316));
  254. double OPTITRACK_Y_SCALE = 0.205 * (((1.2 / 0.0254) * 96) / (1.2));
  255. /// <summary>
  256. /// converts given point to device-independent pixel
  257. /// </summary>
  258. /// <param name="p">real world coordinate</param>
  259. /// <returns>The given Point converted to device-independent pixel </returns>
  260. private Point ConvertTo96thsOfInch(Point p)
  261. {
  262. double xCoordinate = (p.X - OPTITRACK_X_OFFSET) * OPTITRACK_X_SCALE;
  263. double yCoordinate = (OPTITRACK_CANVAS_HEIGHT - (p.Y - OPTITRACK_Y_OFFSET)) * OPTITRACK_Y_SCALE;
  264. return new Point(xCoordinate, yCoordinate);
  265. }
  266. /// <summary>
  267. /// converts given point to pixel, calibrated for video wall in a08
  268. /// </summary>
  269. /// <param name="p"></param>
  270. /// <returns></returns>
  271. private Point ConvertToPixel(Point p)
  272. {//TODO: realize comments
  273. double xCoordinate = (p.X - OPTITRACK_X_OFFSET) * -1 * (/*Anzahl Pixel X-Richtung*/0 / (1.816)) + 0/*1/2 * x-richtung pixel*/; //TODO
  274. double yCoordinate = (((OPTITRACK_CANVAS_HEIGHT + 0/*meter von oberer Rand Leinwand zu oberer Rand Bildschirm*/) - (p.Y - OPTITRACK_Y_OFFSET))) * (/*Anzahl Pixel Y-Richtung*/0 / (1.360));
  275. return new Point(xCoordinate, yCoordinate);
  276. }
  277. /// <summary>
  278. /// Updates the Optitrack coordiantes, aswell as the marker for optitrack.
  279. /// </summary>
  280. /// <param name="p">The new cursor position</param>
  281. public void SetCurrentFingerPosition(Point p)
  282. {
  283. Point correctedPoint = ConvertTo96thsOfInch(p);
  284. if (testing)
  285. {
  286. Console.WriteLine("raw coordinates: " + p.X + ";" + p.Y);
  287. Console.WriteLine(correctedPoint.X + "," + correctedPoint.Y);
  288. }
  289. if (optiTrackZ < -2.2 * WARNING_ZONE_BOUNDARY && OptiLayer > -1)
  290. {
  291. OptiLayer = -1; OptiMovingBack = false;
  292. programPresenter.SetOverlayColor("optipoint", Brushes.Yellow);
  293. }
  294. else if (optiTrackZ > 2 * WARNING_ZONE_BOUNDARY && OptiLayer < 1)
  295. {
  296. programPresenter.SetOverlayColor("optipoint", Brushes.Red);
  297. OptiMovingBack = true; OptiLayer = 1;
  298. }
  299. else if(optiTrackZ <= 2 * WARNING_ZONE_BOUNDARY && optiTrackZ >= -2.2 * WARNING_ZONE_BOUNDARY && OptiLayer != 0){
  300. programPresenter.SetOverlayColor("optipoint", Brushes.Green);
  301. }
  302. currentOptiCursorPosition = correctedPoint;
  303. programPresenter.MoveOptiPoint(currentOptiCursorPosition);
  304. if (optiCursorPositions.Count > 0) { previousOptiCursorPosition = optiCursorPositions.Dequeue(); }
  305. else { previousOptiCursorPosition = currentOptiCursorPosition; }
  306. }
  307. /********************************************/
  308. /*** FUNCTIONS TO INTERACT WITH PRESENTER ***/
  309. /********************************************/
  310. /// <summary>
  311. /// A function to update the dimensions of the left and right canvas when the window is resized.
  312. /// </summary>
  313. /// <param name="LeftCanvas">The size of the left canvas.</param>
  314. /// <param name="RightCanvas">The size of the right canvas.</param>
  315. public void ResizeEvent(ImageDimension LeftCanvas, ImageDimension RightCanvas)
  316. {
  317. if (LeftCanvas.Height >= 0 && LeftCanvas.Width >= 0) { leftImageSize = LeftCanvas; }
  318. if (RightCanvas.Height >= 0 && RightCanvas.Width >= 0) { rightImageSize = RightCanvas; }
  319. RepopulateDeletionMatrixes();
  320. }
  321. /// <summary>
  322. /// A function to reset the right image.
  323. /// </summary>
  324. public void ResetRightImage()
  325. {
  326. if(currentLine.Count > 0)
  327. FinishCurrentLine(true);
  328. rightLineList.Clear();
  329. programPresenter.PassLastActionTaken(historyOfActions.Reset());
  330. programPresenter.ClearRightLines();
  331. }
  332. /// <summary>
  333. /// The function to set the left image.
  334. /// </summary>
  335. /// <param name="width">The width of the left image.</param>
  336. /// <param name="height">The height of the left image.</param>
  337. /// <param name="listOfLines">The List of Lines to be displayed in the left image.</param>
  338. public void SetLeftLineList(int width, int height, List<InternalLine> listOfLines)
  339. {
  340. leftImageSize = new ImageDimension(width, height);
  341. rightImageSize = new ImageDimension(width, height);
  342. leftLineList = listOfLines;
  343. graphicLoaded = true;
  344. programPresenter.UpdateLeftLines(leftLineList);
  345. CanvasActivated();
  346. }
  347. /// <summary>
  348. /// A function to tell the model a new canvas was activated.
  349. /// </summary>
  350. public void CanvasActivated()
  351. {
  352. canvasActive = true;
  353. RepopulateDeletionMatrixes();
  354. UpdateUI();
  355. }
  356. /// <summary>
  357. /// Will undo the last action taken, if the action history allows it.
  358. /// </summary>
  359. public void Undo()
  360. {
  361. if (historyOfActions.CanUndo())
  362. {
  363. HashSet<int> affectedLines = historyOfActions.GetCurrentAction().GetLineIDs();
  364. SketchAction.ActionType undoAction = historyOfActions.GetCurrentAction().GetActionType();
  365. switch (undoAction)
  366. {
  367. case SketchAction.ActionType.Delete:
  368. //Deleted Lines need to be shown
  369. ChangeLines(affectedLines, true);
  370. break;
  371. case SketchAction.ActionType.Draw:
  372. //Drawn lines need to be hidden
  373. ChangeLines(affectedLines, false);
  374. break;
  375. default:
  376. break;
  377. }
  378. programPresenter.UpdateRightLines(rightLineList);
  379. }
  380. RepopulateDeletionMatrixes();
  381. programPresenter.PassLastActionTaken(historyOfActions.MoveAction(true));
  382. UpdateUI();
  383. }
  384. /// <summary>
  385. /// Will redo the last action undone, if the action history allows it.
  386. /// </summary>
  387. public void Redo()
  388. {
  389. if (historyOfActions.CanRedo())
  390. {
  391. programPresenter.PassLastActionTaken(historyOfActions.MoveAction(false));
  392. HashSet<int> affectedLines = historyOfActions.GetCurrentAction().GetLineIDs();
  393. SketchAction.ActionType redoAction = historyOfActions.GetCurrentAction().GetActionType();
  394. switch (redoAction)
  395. {
  396. case SketchAction.ActionType.Delete:
  397. //Deleted Lines need to be redeleted
  398. ChangeLines(affectedLines, false);
  399. break;
  400. case SketchAction.ActionType.Draw:
  401. //Drawn lines need to be redrawn
  402. ChangeLines(affectedLines, true);
  403. break;
  404. default:
  405. break;
  406. }
  407. //TODO: For the person implementing overlay: Add check if overlay needs to be added
  408. programPresenter.UpdateRightLines(rightLineList);
  409. RepopulateDeletionMatrixes();
  410. }
  411. UpdateUI();
  412. }
  413. /// <summary>
  414. /// The function called by the Presenter to change the drawing state of the program.
  415. /// </summary>
  416. /// <param name="nowDrawing">The new drawingstate of the program</param>
  417. public void ChangeState(bool nowDrawing)
  418. {
  419. if(inDrawingMode && !nowDrawing && currentLine.Count > 0)
  420. FinishCurrentLine(true);
  421. inDrawingMode = nowDrawing;
  422. UpdateUI();
  423. }
  424. /// <summary>
  425. /// The function called by the Presenter to set a variable which describes if OptiTrack is in use
  426. /// </summary>
  427. /// <param name="usingOptiTrack"></param>
  428. public void SetOptiTrack(bool usingOptiTrack)
  429. {
  430. optiTrackInUse = usingOptiTrack;
  431. if (usingOptiTrack && optiTrackX == 0 && optiTrackY == 0 && optiTrackZ == 0)
  432. {
  433. programPresenter.PassWarning("Trackable not detected, please check if OptiTrack is activated and Trackable is recognized");
  434. optiTrackInUse = false;
  435. //Disable optipoint
  436. programPresenter.SetOverlayStatus("optipoint", false, currentCursorPosition);
  437. Console.WriteLine("Point disabled");
  438. }
  439. else
  440. {
  441. Console.WriteLine("Point enabled: {0}",optiTrackInUse);
  442. //Enable optipoint
  443. programPresenter.SetOverlayStatus("optipoint", true, currentCursorPosition);
  444. }
  445. }
  446. /// <summary>
  447. /// Updates the current cursor position of the model.
  448. /// </summary>
  449. /// <param name="p">The new cursor position</param>
  450. public void SetCurrentCursorPosition(Point p)
  451. {
  452. if (!optiTrackInUse) currentCursorPosition = p;
  453. //Temporary position of the optipoint change, change this when merging with optitrack branch
  454. mouseDown = programPresenter.IsMousePressed();
  455. }
  456. /// <summary>
  457. /// Start a new Line, when the Mouse is pressed down.
  458. /// </summary>
  459. public void StartNewLine()
  460. {
  461. mouseDown = true;
  462. if (inDrawingMode)
  463. {
  464. if(optiTrackInUse)
  465. {
  466. currentLine.Clear();
  467. currentLine.Add(currentOptiCursorPosition);
  468. }
  469. else if (programPresenter.IsMousePressed())
  470. {
  471. currentLine.Clear();
  472. currentLine.Add(currentCursorPosition);
  473. }
  474. }
  475. }
  476. /// <summary>
  477. /// Finish the current Line, when the pressed Mouse is released.
  478. /// </summary>
  479. /// <param name="valid">Whether the up event is valid or not</param>
  480. public void FinishCurrentLine(bool valid)
  481. {
  482. if (testing)
  483. foreach (Point p in currentLine)
  484. Console.WriteLine(p.X + ";" + p.Y);
  485. mouseDown = false;
  486. if (valid)
  487. {
  488. if (inDrawingMode && currentLine.Count > 0)
  489. {
  490. InternalLine newLine = new InternalLine(currentLine, rightLineList.Count);
  491. rightLineList.Add(new Tuple<bool, InternalLine>(true, newLine));
  492. newLine.PopulateMatrixes(isFilledMatrix, linesMatrix);
  493. programPresenter.PassLastActionTaken(historyOfActions.AddNewAction(new SketchAction(SketchAction.ActionType.Draw, newLine.GetID())));
  494. //TODO: For the person implementing overlay: Add check if overlay needs to be added
  495. programPresenter.UpdateRightLines(rightLineList);
  496. currentLine.Clear();
  497. programPresenter.UpdateCurrentLine(currentLine);
  498. }
  499. }
  500. else
  501. {
  502. currentLine.Clear();
  503. }
  504. UpdateUI();
  505. }
  506. /// <summary>
  507. /// Finish the current Line, when the pressed Mouse is released.
  508. /// Overload that is used to pass a list of points to be used when one is available.
  509. /// </summary>
  510. /// <param name="p">The list of points</param>
  511. public void FinishCurrentLine(List<Point> p)
  512. {
  513. mouseDown = false;
  514. if (inDrawingMode && currentLine.Count > 0)
  515. {
  516. InternalLine newLine = new InternalLine(p, rightLineList.Count);
  517. rightLineList.Add(new Tuple<bool, InternalLine>(true, newLine));
  518. newLine.PopulateMatrixes(isFilledMatrix, linesMatrix);
  519. programPresenter.PassLastActionTaken(historyOfActions.AddNewAction(new SketchAction(SketchAction.ActionType.Draw, newLine.GetID())));
  520. programPresenter.UpdateRightLines(rightLineList);
  521. currentLine.Clear();
  522. }
  523. UpdateUI();
  524. }
  525. void getOptiTrackPosition(OptiTrack.Frame frame)
  526. {
  527. if (frame.Trackables.Length >= 1)
  528. {
  529. optiTrackX = frame.Trackables[0].X;
  530. optiTrackY = frame.Trackables[0].Y;
  531. optiTrackZ = frame.Trackables[0].Z;
  532. /*
  533. Console.WriteLine("X:" + optiTrackX);
  534. Console.WriteLine("Y:" + optiTrackY);
  535. Console.WriteLine("Z:" + optiTrackZ);
  536. */
  537. }
  538. }
  539. /// <summary>
  540. /// Method to be called every tick. Updates the current Line, or checks for Lines to delete, depending on the drawing mode.
  541. /// </summary>
  542. public void Tick()
  543. {
  544. if (cursorPositions.Count > 0) { previousCursorPosition = cursorPositions.Dequeue(); }
  545. else { previousCursorPosition = currentCursorPosition; }
  546. if(optitrackAvailable)
  547. SetCurrentFingerPosition(new Point(optiTrackX, optiTrackY));
  548. if (optiTrackInUse && inDrawingMode && !OptiMovingBack) // optitrack is being used
  549. {
  550. //outside of drawing zone
  551. if (!CheckInsideDrawingZone(optiTrackZ))
  552. {
  553. //Check if trackable was in drawing zone last tick & program is in drawing mode-> finish line
  554. if (optiTrackInsideDrawingZone && inDrawingMode)
  555. {
  556. optiTrackInsideDrawingZone = false;
  557. FinishCurrentLine(true);
  558. if (testing) Console.WriteLine("line finished");
  559. }
  560. }
  561. //Draw with optitrack, when in drawing zone
  562. if (CheckInsideDrawingZone(optiTrackZ))
  563. {
  564. //Optitrack wasn't in the drawing zone last tick -> start a new line
  565. if (!optiTrackInsideDrawingZone)
  566. {
  567. optiTrackInsideDrawingZone = true;
  568. StartNewLine();
  569. if (testing) Console.WriteLine("new line begun");
  570. }
  571. else currentLine.Add(currentOptiCursorPosition);
  572. programPresenter.UpdateCurrentLine(currentLine);
  573. if (optiTrackZ > WARNING_ZONE_BOUNDARY)
  574. {
  575. armband.pushForward();
  576. }
  577. else if (optiTrackZ < -1 * WARNING_ZONE_BOUNDARY)
  578. {
  579. armband.pushBackward();
  580. }
  581. }
  582. }
  583. else if( !optiTrackInUse && inDrawingMode)
  584. {
  585. //drawing without optitrack
  586. cursorPositions.Enqueue(currentCursorPosition);
  587. if (inDrawingMode && programPresenter.IsMousePressed())
  588. {
  589. currentLine.Add(currentCursorPosition);
  590. //programPresenter.UpdateCurrentLine(currentLine);
  591. }
  592. }
  593. //Deletion mode for optitrack and regular use
  594. if (!inDrawingMode)
  595. {
  596. List<Point> uncheckedPoints = new List<Point>();
  597. if (programPresenter.IsMousePressed() && !optiTrackInUse) //without optitrack
  598. uncheckedPoints = GeometryCalculator.BresenhamLineAlgorithm(previousCursorPosition, currentCursorPosition);
  599. if(optiTrackInUse && CheckInsideDrawingZone(optiTrackZ) && !OptiMovingBack)
  600. {//with optitrack
  601. uncheckedPoints = GeometryCalculator.BresenhamLineAlgorithm(previousOptiCursorPosition, currentOptiCursorPosition);
  602. }
  603. foreach (Point currPoint in uncheckedPoints)
  604. {
  605. HashSet<int> linesToDelete = CheckDeletionMatrixesAroundPoint(currPoint, deletionRadius);
  606. if (linesToDelete.Count > 0)
  607. {
  608. programPresenter.PassLastActionTaken(historyOfActions.AddNewAction(new SketchAction(SketchAction.ActionType.Delete, linesToDelete)));
  609. foreach (int lineID in linesToDelete)
  610. {
  611. rightLineList[lineID] = new Tuple<bool, InternalLine>(false, rightLineList[lineID].Item2);
  612. }
  613. RepopulateDeletionMatrixes();
  614. programPresenter.UpdateRightLines(rightLineList);
  615. }
  616. }
  617. }
  618. }
  619. /*
  620. private void projectPointOntoScreen(float optiTrackX, float optiTrackY)
  621. {
  622. Point auxiliaryPoint = ConvertToPixel(new Point(optiTrackX, optiTrackY));
  623. //SetCursorPos((int)auxiliaryPoint.X, (int)auxiliaryPoint.Y);
  624. }
  625. */
  626. private bool CheckInsideDrawingZone(float optiTrackZ)
  627. {
  628. if (Math.Abs(optiTrackZ) > WARNING_ZONE_BOUNDARY * 2) return false;
  629. return true;
  630. }
  631. /// <summary>
  632. /// If there is unsaved progress.
  633. /// </summary>
  634. /// <returns>True if there is progress that has not been saved.</returns>
  635. public bool HasUnsavedProgress()
  636. {
  637. return !historyOfActions.IsEmpty();
  638. }
  639. }
  640. }