Add Command Parser

Vitis_Classic/NewInstrCalBoard/src/main.c

@@ -77,7 +77,34 @@ int main()
 		{
 			xil_printf("[E] UART Receive ERROR!!! Check PrintOut Ahead\r\n");
 		}
-		
+		switch (recvbuffer[0])
+		{
+			case 0xA0:
+			{
+				xil_printf("[D] Matched Command Reset\r\n");
+				rst_CPLD(CPLD_U1,4);
+				rst_CPLD(CPLD_U2,4);
+				rst_CPLD(CPLD_U3,4);
+				xil_printf("[I] CPLD RST Done\r\n");
+				break;
+			}
+			case 0xA1:			//PMU Cal
+			{
+				break;
+			}
+			case 0xA2:			//Freq Cal
+			{
+
+				break;
+			}
+			
+			default:
+			{
+				xil_printf("[E] Command Header No Match! \r\n[D] Received Command Header:0x%02X Check Command!\r\n",recvbuffer[0]);
+				break;
+			}
+			
+		}
 	}
 
 	/* never reached */