Fix for Upstream JTAG lockout - don't execute WFI too soon!

Upstream/Src/main.c

@@ -68,9 +68,9 @@ int main(void)
     GPIO_Init();
     LED_Init();
     USB_Device_Init();
-
     Upstream_InitStateMachine();
 
+    HAL_Delay(200);         //Delay executing WFI to avoid destroying JTAG access
 
     while (1)
     {