first running version of game

Author: Nico

MotionTest_Console/.vs/MotionTest_Console/v15/.suo

@@ -4,6 +4,7 @@
 using System.Linq;
 using System.Text;
 using System.Threading.Tasks;
+using System.Timers;
 
 namespace BallInAMaze
 {
@@ -32,6 +33,8 @@ public class MotionData
         // Start Condition that is sent to Board at startup
         private readonly byte[] StartCondition = new byte[2] { 0xAF, 0xFE };
 
+        private Timer timer;
+
         /// <summary>
         /// CTOR
         /// </summary>
@@ -96,6 +99,18 @@ public MotionData(int PortNumber)
                 StartUpFailed?.Invoke(this, EventArgs.Empty);
                 return;
             }
+
+            timer = new Timer();
+            timer.Elapsed += new ElapsedEventHandler(OnTimedEvent);
+            timer.Interval = 5000; // 1 sec
+            timer.Enabled = true;
+            timer.AutoReset = false;
+        }
+
+        private void OnTimedEvent(object sender, ElapsedEventArgs e)
+        {
+            byte[] stop = { 0x01 };
+            mPort.Write(stop, 0, 1);
         }
 
         // THIS method can be exchanged if we are not longer

MotionTest_Console/MotionData.cs

@@ -98,7 +98,20 @@ private void Data_StartUpFailed(object sender, EventArgs e)
 
         private void Data_NewDataArrived(object sender, EventArgs e)
         {
-            Console.WriteLine("X: {0} Y: {1} Z: {2}", data.Axis_X.ToString().PadRight(8), data.Axis_Y.ToString().PadRight(8), data.Axis_Z.ToString().PadRight(8));
+            // Calculate movement of ball
+            int Diff_X = Old_Value_X + data.Axis_X;
+            int Diff_Y = Old_Value_Y + data.Axis_Y;
+
+            double move_x = Diff_X / 5000.0;
+            move_x = Math.Round(move_x, 1);
+            double move_y = Diff_Y / 5000.0;
+            move_y = Math.Round(move_y, 1);
+
+            // Save new values
+            Old_Value_X = data.Axis_X;
+            Old_Value_Y = data.Axis_Y;
+
+            Console.WriteLine("X: {0} Y: {1} Z: {2}", move_x.ToString().PadRight(8), move_y.ToString().PadRight(8), data.Axis_Z.ToString().PadRight(8));
 
             // Kalibrierung nach StartUp
             // SetBallPosition + Überprüfung + Event an ModelView wenn Kugel in Loch oder Kugel in Ziel

MotionTest_Console/TheGame.cs

@@ -27,6 +27,9 @@
 // to be used to BLOCK wait for UART data
 #define UART_RECV_BYTE()		XUartPs_RecvByte(XPAR_PS7_UART_1_BASEADDR)
 
+// to be used to clear RECV buffer of UART
+#define UART_CLEAR_RECV_BUF()	XUartPs_WriteReg(XPAR_PS7_UART_1_BASEADDR, XUARTPS_CR_OFFSET, (u32)XUARTPS_CR_RXRST);
+
 // START condition to be recieved from APPLICATION
 #define START_CONDITION			0xAFFE
 
@@ -53,8 +56,22 @@ int main()
     LIS2DS12_Init();
 
 START:
+	// Discard all DATA in RECEIVE BUFFER
+    UART_CLEAR_RECV_BUF();
+
     // STARTUP PHASE --> ***BLOCKING*** until start condition is received
-    if(StartUp_Phase() != SUCCESS) return FAILURE;
+    if(StartUp_Phase() != SUCCESS)
+    {
+    	// While USER has NOT pressed RESET button --> wake up every 100 ms and check
+		while(!GPIO_Get_PS_Button())
+		{
+			// Send data every 100 ms (10 times in a second)
+			usleep(100000);
+		}
+
+		// Then go back to START
+		goto START;
+    }
 
     // Prevent PROGRAM from EXITING
     while(1)
@@ -64,6 +81,23 @@ int main()
     		goto START;
     	}
 
+    	// Check if Application sent command ...
+    	if(XUartPs_IsReceiveData(XPAR_PS7_UART_1_BASEADDR))
+    	{
+    		// DECODE COMMAND
+    		switch(UART_RECV_BYTE())
+    		{
+    		case 0x01:
+    			// STOP COMMAND --> go to START
+    			goto START;
+    		case 0x02:
+    			break;
+    		default:
+    			// Unknown COMMAND
+    			break;
+    		}
+    	}
+
 		// Read and Print Motion values
     	motion = LIS2DS12_Get_Motion();