added delay for CAN

Core/Src/main.c

@@ -134,6 +134,7 @@ int main(void)
     /* USER CODE END WHILE */
 
     /* USER CODE BEGIN 3 */
+    /*
     int ttt = HAL_GetTick() + 45000;
     PWM_powerground_control(0);
     while (HAL_GetTick() < ttt){}
@@ -143,11 +144,12 @@ int main(void)
     PWM_powerground_control(15);
     ttt = HAL_GetTick() + 5000;
     while (HAL_GetTick() < ttt){}
+    */
 
-    //AMS_Loop();
-    //sm_update();
+    AMS_Loop();
+    sm_update();
     //sm_test_cycle_states();
-    //can_handle_send_status();
+    can_handle_send_status();
   }
   /* USER CODE END 3 */
 }