小改動

feat: 開啟Vol_Loop_LLC()
開啟 vac brown out protector
2026-06-10 11:36:25 +08:00 · 2026-05-28 11:35:52 +08:00 · 2026-05-28 10:35:10 +08:00 · 2026-05-27 17:28:29 +08:00 · 2026-05-27 16:44:03 +08:00 · 2026-05-27 15:38:58 +08:00
6 changed files with 217 additions and 1261 deletions
@@ -21,7 +21,7 @@
 							<option id="ilg.gnumcueclipse.managedbuild.cross.riscv.option.addtools.createflash.249191345" name="Create flash image" superClass="ilg.gnumcueclipse.managedbuild.cross.riscv.option.addtools.createflash" value="true" valueType="boolean"/>
 							<option id="ilg.gnumcueclipse.managedbuild.cross.riscv.option.addtools.createlisting.243120876" name="Create extended listing" superClass="ilg.gnumcueclipse.managedbuild.cross.riscv.option.addtools.createlisting" value="true" valueType="boolean"/>
 							<option id="ilg.gnumcueclipse.managedbuild.cross.riscv.option.addtools.printsize.1566043258" name="Print size" superClass="ilg.gnumcueclipse.managedbuild.cross.riscv.option.addtools.printsize" value="true" valueType="boolean"/>
-							<option id="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.level.1801001334" name="Optimization Level" superClass="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.level" value="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.level.more" valueType="enumerated"/>
+							<option id="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.level.1801001334" name="Optimization Level" superClass="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.level" value="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.level.optimize" valueType="enumerated"/>
 							<option id="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.messagelength.651682061" name="Message length (-fmessage-length=0)" superClass="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.messagelength" value="true" valueType="boolean"/>
 							<option id="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.signedchar.1219903449" name="'char' is signed (-fsigned-char)" superClass="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.signedchar" value="true" valueType="boolean"/>
 							<option id="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.functionsections.168524687" name="Function sections (-ffunction-sections)" superClass="ilg.gnumcueclipse.managedbuild.cross.riscv.option.optimization.functionsections" value="true" valueType="boolean"/>
@@ -32,11 +32,11 @@ extern "C"
 #define YN_MAX            (PFC_DUTY_MAX << 14)
 #define YN_MIN            (PFC_DUTY_MIN << 14)
 // VBUS 參數
-#define VBUS_SET          340             // unit: volt (Transformer N = 14)
-#define VBUS_SET_H        (VBUS_SET + 30) // burst mode in,  在過零區判斷
+#define VBUS_SET          350             // unit: volt (Transformer N = 14)
+#define VBUS_SET_H        (VBUS_SET + 20) // burst mode in,  在過零區判斷
 #define VBUS_SET_L        (VBUS_SET - 20) // burst mode out, 在過零區判斷
 // #define VBUS_SET_H2			370 	// for skip mode
-#define VBUS_OVP          410     // 420V 電容
+#define VBUS_OVP          420     // 420V 電容
 #define VBUS_2ADC         149.15f // 4M + 27K
 #define VCOMP_2DUTY       0       // vbus_comp control duty
 #define V_COMP_MAX        16000   // (PFC_DUTY_MAX * 32) 	// 480 * 32 = 16360
@@ -16,8 +16,8 @@
 #define CR_1P1Z_A1_Q14 -5803
 // 前饋輸出限制（請根據您主環 Q14 格式的數值範圍調整）
 // 假設最大前饋量限制為實數值 50.0 -> 50.0 * 16384 = 819200
-#define CR_FF_MAX_Q14  819200 // 50 duty << 14
-#define CR_FF_MIN_Q14  -819200
+#define CR_FF_MAX_Q14  1638400 //819200 // 50 duty << 14
+#define CR_FF_MIN_Q14  -1638400 //-819200

 //=============================================================================
 //                  Macro Definition
@@ -62,12 +62,11 @@ typedef enum
 SystemState_t sys_state = STATE_INIT;
 uint8_t is_zero_crossing = 0;
 uint8_t burst_mode_active = 0;
-uint8_t skip_mode_active = 0;
 uint8_t llc_running = 0;
 uint8_t pfc_running = 0;
 static uint8_t last_is_zero_crossing = 0;
 uint8_t is_brown_in = 0; // 0: 關機/保護中, 1: 正常工作
-uint8_t ff_active = 0;
+static uint8_t cur_loop_fun_en = 0;

 // static volatile int32_t print1, print2;
 // static volatile int64_t print3;
@@ -128,8 +127,7 @@ static volatile uint16_t vac_pk1, vac_pk2;
 uint8_t hi_line = 0; // 0=110V, 1=220V
 uint8_t vbus_ready = 0;
 uint16_t hi_cnt, lo_cnt;
-uint32_t static digital_vcomp = (LLC_PERIOD_MAX - LLC_PERIOD_MIN)
-                                << LLC_COMP_GAIN_BIT;
+uint32_t static digital_vcomp = (LLC_PERIOD_MAX - LLC_PERIOD_MIN) << LLC_COMP_GAIN_BIT;
 int16_t fb_enent;
 uint16_t llc_period_ss = LLC_SS_MIN;
 uint16_t llc_run_arr = LLC_PERIOD_MIN;
@@ -289,18 +287,15 @@ void Power_Off()
 //===================================================================================
 void llc_set_period(uint16_t val)
 {
-  if (val > LLC_PERIOD_MAX)
-    val = LLC_PERIOD_MAX; // 可以小，不能過大
+  if (val > LLC_PERIOD_MAX) val = LLC_PERIOD_MAX; // 可以小，不能過大
  EPWM->ARR = val;
  EPWM->CCR1 = val >> 1;
 }
 //===================================================================================
 void pfc_set_duty(uint16_t val)
 {
-  if (val > PFC_DUTY_MAX)
-    val = PFC_DUTY_MAX;
-  if (val < PFC_DUTY_MIN)
-    val = PFC_DUTY_MIN;
+  if (val > PFC_DUTY_MAX) val = PFC_DUTY_MAX;
+  if (val < PFC_DUTY_MIN) val = PFC_DUTY_MIN;
  TIM2->CCR1 = val;
 }
 //===================================================================================
@@ -333,7 +328,7 @@ void Load_Loop_1P1Z(void)
  int32_t y0;

  // 1. 讀取當前 vcr
-  x0 = vcr;
+  x0 = vcr_avg;

  // 2. 執行 1P1Z 差分方程計算:
  temp_y0 = ((int64_t)CR_1P1Z_B0_Q14 * x0) + ((int64_t)CR_1P1Z_B1_Q14 * vcr_x1_q14) - ((int64_t)CR_1P1Z_A1_Q14 * vcr_y1_q14);
@@ -347,32 +342,35 @@ void Load_Loop_1P1Z(void)

  // 定點數安全限幅 (Saturation)
  if (y0 > CR_FF_MAX_Q14)
-    y0 = CR_FF_MAX_Q14; // 868352 = 53 duty
+    y0 = CR_FF_MAX_Q14;
  else if (y0 > -CR_FF_MIN_Q14)
    y0 = -CR_FF_MIN_Q14;

  cr_feed_forward_output_q14 = y0;
 }
 //==========================================================================
-void Vol_Loop_PFC_1P1Z(void) // TEST OK
+void Vol_Loop_PFC_1P1Z(void)
 {
  // 1. 計算誤差
  int32_t vbus_err_n = (int32_t)vbus_set - (int32_t)vbus_avg;

  // --- 策略 A：動態增益調整 ---
-  // int32_t b0 = 135;
-  // int32_t b1 = -134;
-  int32_t b0 = 180;
-  int32_t b1 = -175;
+   int32_t b0 = 139;
+   int32_t b1 = -129;

-  // if (vbus_err_n > 30 || vbus_err_n < -30)
-  if (vbus_err_n > 80 || vbus_err_n < -80) // ~ 20V
+  //  vloop_p->b0 = 139;
+  //  vloop_p->b1 = -129;
+  //  vloop_p->a1 = -16383;
+/*
+  if (vbus_err_n > 40 || vbus_err_n < -40) // ~ 20V
  {
    // 大誤差時（通常是剛啟動或大跳載），強化參數加快反應
-    b0 = 250;
-    b1 = -240;
-    // b0 = 180; // 稍微調降強增益的力道
-    // b1 = -175;
+    //b0 = 250;
+    //b1 = -249;
+     //b0 = 180; // 稍微調降強增益的力道
+     //b1 = -178;
+	 b0 = 500;
+	 b1 = -499;
  }
  // --- 策略 B：接近目標時微調零點 (抗過衝) ---
  else if (vbus_err_n < 20 && vbus_err_n > -20) // ~ 5V
@@ -381,14 +379,35 @@ void Vol_Loop_PFC_1P1Z(void) // TEST OK
    b0 = 120;
    b1 = -119; // 如果不能用浮點數，請維持 120 / -119，增加阻尼感
  }
-
+*/
  // 2. 差分方程計算
  int64_t acc = (int64_t)b0 * vbus_err_n;
  acc += (int64_t)b1 * vbus_err_1;
-  acc += ((int64_t)16384 * vbus_comp_1) >> 14; // 16384 = 1 >> 14
+  acc += ((int64_t)16383 * vbus_comp_1) >> 14; // 16384 = 1 >> 14

  int32_t y_n = (int32_t)acc;

+#if 0 // 有問題
+	// --- 策略 C：軟限制抗過衝 (Soft Clamping) ---
+	// 預設最大限制 (Duty 300 << 14)
+	int32_t current_max_limit = 4915200; // duty 300
+
+	// 如果電壓誤差已經很小（例如剩 15V 就到達），甚至已經發生過衝 (err < 0)
+	// 我們強制壓低 Duty 的允許上限，防止積分器帶著大 Duty 衝過頭
+	if (vbus_err_n < 15)
+	{
+		// 這裡的 3276800 對應 Duty 200，您可以根據 800W 穩態時的 Duty 大約位置來設定
+	    // 核心目標是：不讓 Duty 在接近目標時還維持在 300 這麼高
+	    current_max_limit = 3276800; // duty 200
+	}
+
+	// 如果發生明顯過衝 (電壓高於目標 5V 以上)
+	if (vbus_err_n < -5)
+	{
+		current_max_limit = 1638400; // 強制壓低到 Duty 100 快速拉回
+	}
+#endif
+
  // 3. 輸出限幅執行
  if (y_n > YN_MAX)
    y_n = YN_MAX;
@@ -400,12 +419,13 @@ void Vol_Loop_PFC_1P1Z(void) // TEST OK
  vbus_comp_1 = y_n;

  // 5. 輸出 Duty >> 14
-  // if (sys_state == STATE_PFC_SOFT_START || sys_state == STATE_RUN_SKIP) // 緩啟動期間直接控制 DUTY
-  TIM2->CCR1 = (vbus_comp_1 >> 14); // 0 ~ 540
+  if (sys_state == STATE_PFC_SOFT_START || sys_state == STATE_RUN_SKIP) // 緩啟動期間直接控制 DUTY
+	  TIM2->CCR1 = (vbus_comp_1 >> 14); // 0 ~ 540

  // 6. 輸出 comp >> 9 (變大 32 倍) (MAX ~ 18000) (540*32=17280)差不多，>> 9 應該是對的
  // if (sys_state == STATE_RUN_NORMAL) // 正常工作時間輸出 COMP 值
-  vbus_comp2 = (vbus_comp_1 >> 9);
+  vbus_comp2 = (vbus_comp_1 >> 9) + (cr_feed_forward_output_q14 << 1); // 太大會直接 OVP
+  //vbus_comp2 = (vbus_comp_1 >> 9);
 }
 //=============================================================
 static void Vol_Loop_PFC_1P1Z_UI(void) // ZERO: 120HZ, POLE:0.1HZ, G:10
@@ -435,12 +455,12 @@ static void Vol_Loop_PFC_1P1Z_UI(void) // ZERO: 120HZ, POLE:0.1HZ, G:10
  vbus_comp_1 = y_n;

  // 5. 輸出 Duty >> 14
-  //if (sys_state == STATE_PFC_SOFT_START || sys_state == STATE_RUN_SKIP) // 緩啟動期間直接控制 DUTY
-    TIM2->CCR1 = (vbus_comp_1 >> 14);                                   // 0 ~ 540
+  if (sys_state == STATE_PFC_SOFT_START || sys_state == STATE_RUN_SKIP) // 緩啟動期間直接控制 DUTY
+	  TIM2->CCR1 = (vbus_comp_1 >> 14); // 0 ~ 540

  // 6. 輸出 comp >> 9 (變大 32 倍) (MAX ~ 18000) (540*32=17280)差不多，>> 9 應該是對的
-  //if (sys_state == STATE_RUN_NORMAL) // 正常工作時間輸出 COMP 值
-    vbus_comp2 = (vbus_comp_1 >> 9);
+  // if (sys_state == STATE_RUN_NORMAL) // 正常工作時間輸出 COMP 值
+  vbus_comp2 = (vbus_comp_1 >> 9);
 }

 //========================================================================
@@ -461,8 +481,7 @@ __attribute__((always_inline)) static inline void Cur_Loop_PFC_2P2Z(void) // 優
    local_iac = 0; // 避免負值

  // 計算電流給定值
-  // int32_t local_iac_set = (local_vac_avg1 * local_vbus_comp2) / 5700;
-  int32_t local_iac_set = (local_vac_avg1 * local_vbus_comp2) >> 13; // >> 13 = / 8192 (解析度較高)
+  int32_t local_iac_set = (local_vac_avg1 * local_vbus_comp2) >> 12; // >> 12 = / 4096
  int32_t local_iac_err_0 = local_iac_set - local_iac;               // err = set - meas

  // 2. 2P2Z 運算 (Fixed-point Q14)
@@ -494,10 +513,13 @@ __attribute__((always_inline)) static inline void Cur_Loop_PFC_2P2Z(void) // 優
  uint16_t local_duty = 0;

  int32_t ff_term;
-  if (vac_avg1 > 0) ff_term = ((uint32_t)(vbus_avg - vac_avg1) * PFC_DUTY_MAX) / vbus_avg;
-  // if (vac_avg1 > 0)	ff_term = ((uint32_t) (2300 - vac_avg1) * PFC_DUTY_MAX) / 2300; // 2500=300V(不需要太高), 2300 會振??
-  //  低一點中間不會有尖波，且輸出功率小一點
-  local_duty = (uint16_t)((y_n >> 14) + ff_term);
+  ff_term = (2800 - vac_avg1) * PFC_DUTY_MAX / 2800 - 200;
+
+  if (ff_term < 0) ff_term = 0;
+  if (vbus_comp2 >= 1000)
+    local_duty = (uint16_t)((y_n >> 14) + ff_term);
+  else
+    local_duty = (uint16_t)(y_n >> 14);

  // local_duty = (uint16_t)(y_n >> 14);
  //  4. 硬體 Duty 限幅與輸出
@@ -550,8 +572,7 @@ void Vol_Loop_LLC(void) // 測試可工作
  else
  {
    // 如果 GPIO 長時間沒翻轉，說明離目標還很遠
-    if (stable_timer < 1000)
-      stable_timer++;
+    if (stable_timer < 1000) stable_timer++;
  }

  // 3. 根據翻轉頻率決定步長
@@ -562,8 +583,7 @@ void Vol_Loop_LLC(void) // 測試可工作
    current_step = 0; // 設為 0 表示進入死區，完全停止震盪

    // 為了防止永久卡死，當連續相同狀態一段時間後再恢復調整
-    if (stable_timer > 50)
-      toggle_cnt = 0;
+    if (stable_timer > 50) toggle_cnt = 0;
  }
  else
  {
@@ -589,10 +609,8 @@ void Vol_Loop_LLC(void) // 測試可工作
  // 5. 計算並更新 ARR (原本的邏輯)
  uint32_t new_arr = LLC_PERIOD_MIN + (digital_vcomp >> LLC_COMP_GAIN_BIT);

-  if (new_arr > LLC_PERIOD_MAX)
-    new_arr = LLC_PERIOD_MAX;
-  if (new_arr < LLC_PERIOD_MIN)
-    new_arr = LLC_PERIOD_MIN;
+  if (new_arr > LLC_PERIOD_MAX) new_arr = LLC_PERIOD_MAX;
+  if (new_arr < LLC_PERIOD_MIN) new_arr = LLC_PERIOD_MIN;

  if (EPWM->ARR != new_arr)
  {
@@ -614,9 +632,9 @@ __INTERRUPT void isr_adc_handle(void)
  iac = ADC0->DAT9_b.DATA;  // PA7, AIN9
  vac = ADC0->DAT7_b.DATA;  // PA13, AIN7
  vbus = ADC0->DAT4_b.DATA; // PA10, AIN4
-  // vcr = ADC0->DAT5_b.DATA;  // PA11, AIN5
+  vcr = ADC0->DAT5_b.DATA;  // PA11, AIN5

-  //Cur_Loop_PFC_2P2Z(); // current loop
+  if (cur_loop_fun_en) Cur_Loop_PFC_2P2Z(); // current loop

  // GPIO_ResetBits(GPIOA, GPIO_Pin_06);

@@ -644,9 +662,10 @@ void Handle_UART_Monitor(void)
  static uint32_t msg_timer = 0;
  if (sys_get_tick() - msg_timer >= 1000) // msg_out = 1, print
  {
-    // printf("%d %d %d\r\n", vac_pk1, vac_pk2, is_brown_in);
+    printf("%d\r\n", vac);
    // printf("%d %d %d %d %d %d", power_on_cmd, sys_state, vbus_comp2, print1, print2, print3);
-    msg("%d %d %d %d\r\n", power_on_cmd, sys_state, vbus_comp2, vbus_avg);
+    //msg("%d %d %d", power_on_cmd, sys_state, vac_pk2);
+    //msg("%d %d %d", iac, vac, vbus);
    // 電壓環輸出最大 COMP，但是電流環輸出最小 DUTY
    msg_timer = sys_get_tick();
  }
@@ -673,8 +692,7 @@ void Vac_Peak_Detector(void)
  {
    is_zero_crossing = 0;
    last_is_zero_crossing = 0;
-    if (vac > vac_pk1)
-      vac_pk1 = vac; // 只有比目前紀錄大才更新，確保 vac_pk1 停在波峰
+    if (vac > vac_pk1) vac_pk1 = vac; // 只有比目前紀錄大才更新，確保 vac_pk1 停在波峰
  }
  else
  {
@@ -689,14 +707,12 @@ void Vac_Peak_Detector(void)
      if (is_brown_in == 0)
      {
        // 目前處於關閉狀態，檢查是否達到啟動門檻
-        if (vac_pk2 >= VOLT_BROWN_IN)
-          is_brown_in = 1; // 執行 Brown-in
+        if (vac_pk2 >= VOLT_BROWN_IN) is_brown_in = 1; // 執行 Brown-in
      }
      else
      {
        // 目前處於啟動狀態，檢查是否低於欠壓門檻
-        if (vac_pk2 < VOLT_BROWN_OUT)
-          is_brown_in = 0; // 執行 Brown-out
+        if (vac_pk2 < VOLT_BROWN_OUT) is_brown_in = 0; // 執行 Brown-out
      }

      vac_pk1 = 0;               // 交接完後立即清零，為下半周做準備
@@ -739,78 +755,109 @@ int main(void)
  // 基礎硬體底層設定 (HIRC 60MHz, GPIO, ADC 採樣率 1Msps) [cite: 55, 127, 184]
  SYS_Config();

+  //pfc_set_duty(15);
+  //pfc_pwm_enable();
+  //while(1);
+
+  //llc_set_period(600);
+  //llc_pwm_enable();
+  //while(1);
+
+  /*
+  while(1)
+  {
+	  Handle_UART_Monitor();
+  }
+   */
+
  // PFC 電流環參數
  bode_plot_param_read_from_flash(bplot_p, FLASH_PROG_ADDR_USER_CALI);

  /*********************************************************************/
  /* PFC 電壓環參數*/
-  vloop_p->a2 = 0;
-  vloop_p->b2 = 0;
+  //  vloop_p->a2 = 0;
+  //  vloop_p->b2 = 0;

-  // 120HZ, 0.1Hz, 100G
-  vloop_p->b0 = 139;
-  vloop_p->b1 = -129;
-  vloop_p->a1 = -16383;
+  //  // 120HZ, 0.1Hz, 100G
+  //  vloop_p->b0 = 139;
+  //  vloop_p->b1 = -129;
+  //  vloop_p->a1 = -16383;
  /*********************************************************************/
  /* PFC 電流環參數*/
-  // bplot_p->b0 = 12368803;
-  // bplot_p->b1 = -19162610;
-  // bplot_p->b2 = 7037429;
-  // bplot_p->a1 = -20921;
-  // bplot_p->a2 = 4545;
+  //bplot_p->b0 = 3353681;
+  //bplot_p->b1 = -1577632;
+  //bplot_p->b2 = -1712512;
+  //bplot_p->a1 = -20921;
+  //bplot_p->a2 = 4545;
  /*********************************************************************/

-#if 1 // 單測 PFC 電壓環 (OK)
-
-  while(1)
+#if 0 // 單測 PFC 電壓環 (OK)
+      /* PFC 電壓環參數*/
  {
-  	    if (tim0_trigger == 1) // 100KHZ
-  		{
-  			tim0_trigger = 0;
-  		    // --- 1. 高速信號濾波 (簡易位移算法減少算力消耗) ---
-  			vac_avg1 = (vac_avg1 - (vac_avg1 >> 3)) + (vac >> 3);	// for current loop
-      		vbus_avg = (vbus_avg - (vbus_avg >> 4)) + (vbus >> 4);	// for voltage loop
-      		vcr_avg = (vcr_avg - (vcr_avg >> 3)) + (vcr >> 3);
-      		if (vbus > vbus_ovp) Power_Off(); // ovp
+    vloop_p->a2 = 0;
+    vloop_p->b2 = 0;

-      		Vac_Peak_Detector();
+    // 120HZ, 0.1Hz, 100G
+    vloop_p->b0 = 139;
+    vloop_p->b1 = -129;
+    vloop_p->a1 = -16383;
+  }

-      		if (power_on_cmd == 1)
-      		{
-   				if (pfc_running == 0)
-   				{
-   					pfc_pwm_enable();
-   					pfc_running = 1;
-   				}
+  cur_loop_fun_en = 0; // 關閉電流環，專測電壓環
+  sys_state = STATE_PFC_SOFT_START;

-   				if (++v_loop_cnt >= 10) // 10KHZ
-   				{
-   					//Vol_Loop_PFC_1P1Z_UI();
-   					Vol_Loop_PFC_1P1Z();
-   					v_loop_cnt = 0;
-   				}
-   			}
-      	}
+  while (1)
+  {
+    //uart_rx_task();

-  	    Key1_Scan();
+    if (tim0_trigger == 1) // 100KHZ
+    {
+      tim0_trigger = 0;
+      // --- 1. 高速信號濾波 (簡易位移算法減少算力消耗) ---
+      vac_avg1 = (vac_avg1 - (vac_avg1 >> 3)) + (vac >> 3);  // for current loop
+      vbus_avg = (vbus_avg - (vbus_avg >> 4)) + (vbus >> 4); // for voltage loop
+      vcr_avg = (vcr_avg - (vcr_avg >> 3)) + (vcr >> 3);
+      if (vbus_avg > vbus_ovp) Power_Off(); // ovp

-  	  //Handle_UART_Monitor();
+      Vac_Peak_Detector();

+      if (power_on_cmd == 1)
+      {
+        if (pfc_running == 0)
+        {
+          pfc_pwm_enable();
+          pfc_running = 1;
+        }

-  	    if (is_full == 1)
-  	    {
-  	    	sys_delay(10);
-  	    	Handle_UART_Log();
-  	    }
+        if (++v_loop_cnt >= 10) // 10KHZ
+        {
+          //Vol_Loop_PFC_1P1Z_UI();
+          Vol_Loop_PFC_1P1Z(); // 800W 板子會低 13V
+          v_loop_cnt = 0;
+        }
+      }
+    }
+
+    Key1_Scan();
+
+    //Handle_UART_Monitor();

  }
 #endif

 #if 0 // 單測 PFC 電流環 (OK)
+      /* PFC 電流環參數*/
+      // Z1=200, Z2=1000000, P1=10, P2=20000, G=10000
+  bplot_p->b0 = 3353681;
+  bplot_p->b1 = -1577632;
+  bplot_p->b2 = -1712512;
+  bplot_p->a1 = -20114;
+  bplot_p->a2 = 3737;

+  cur_loop_fun_en = 1; // 開啟電流環，專測電流環
  while (1)
  {
-    uart_rx_task();
+    //uart_rx_task();
    if (tim0_trigger == 1) // 100KHZ
    {
      tim0_trigger = 0;
@@ -832,7 +879,7 @@ int main(void)
          // vbus_comp_1 = (10 << 14); // 假設從一個極小的係數開始
          vbus_err_1 = 0; // 清除誤差歷史
          // vbus_comp2 = (vbus_comp_1 >> 9); // 讓電流環拿到的初始值是 10
-          vbus_comp2 = 3000;
+          vbus_comp2 = 4000; // 2000 不足，2500 過壓
          // vset / 5700
          // vbus_comp2: 3000, 275V / 0.25A = 68W
          // vbus_comp2: 4000, 314V / 0.25A = 78W
@@ -842,7 +889,7 @@ int main(void)
          // vbus_comp2: 4000, 267V / 0.25A = 66W
          // vbus_comp2: 5000, 293V / 0.25A = 73W

-          // vbus_comp2: 2000, 298V / 0.25A = 75W ?? 波形不對
+          // vbus_comp2: 2000, 298V / 0.25A = 75W ?? 波形不對 ff 的問題
          // vbus_comp2: 1000, 398V / 0.25A = 75W ??
        }
        else if (sys_state == STATE_RUN_NORMAL)
@@ -863,8 +910,23 @@ int main(void)
 	TIM2->CCR1 = 12; // min duty
 	sys_state = STATE_PFC_SOFT_START;

-	Vac_Peak_Detector();
-	pfc_running = 0;
+	cur_loop_fun_en = 0; // 一開始關閉電流環，專測電流環
+	  {
+	    vloop_p->a2 = 0;
+	    vloop_p->b2 = 0;
+
+	    // 120HZ, 0.1Hz, 100G
+	    vloop_p->b0 = 139;
+	    vloop_p->b1 = -129;
+	    vloop_p->a1 = -16383;
+	  }
+      {
+    	  bplot_p->b0 = 3353681;
+    	  bplot_p->b1 = -1577632;
+    	  bplot_p->b2 = -1712512;
+    	  bplot_p->a1 = -20114;
+    	  bplot_p->a2 = 3737;
+      }

 	while(1)
    {
@@ -890,6 +952,7 @@ int main(void)
    				if (++v_loop_cnt >= 10) // 10KHZ
    				{
    					Vol_Loop_PFC_1P1Z_UI();
+    					//Vol_Loop_PFC_1P1Z();
    					v_loop_cnt = 0;
    				}

@@ -901,6 +964,7 @@ int main(void)
    					vbus_comp_1 = (10 << 14); // 假設從一個極小的係數開始
    					vbus_err_1 = 0;           // 清除誤差歷史
    					vbus_comp2 = (vbus_comp_1 >> 9); // 讓電流環拿到的初始值是 10
+    					cur_loop_fun_en = 1; // 開啟電流環
    				}
    			}

@@ -914,6 +978,7 @@ int main(void)
    				if (++v_loop_cnt >= 10) // 10KHZ
    				{
    					Vol_Loop_PFC_1P1Z_UI();
+    					//Vol_Loop_PFC_1P1Z();
    					v_loop_cnt = 0;
    				}
    			}
@@ -925,6 +990,16 @@ int main(void)
 #endif

  // main loop
+
+  /* PFC 電流環參數*/
+  // Z1=200, Z2=100000, P1=10, P2=20000, G=8000
+    bplot_p->b0 = 3353681;
+    bplot_p->b1 = -1577632;
+    bplot_p->b2 = -1712512;
+    bplot_p->a1 = -20114;
+    bplot_p->a2 = 3737;
+
+  cur_loop_fun_en = 1; // 開啟電流環，專測電流環
  while (1)
  {
    uart_rx_task();
@@ -940,28 +1015,27 @@ int main(void)
      vcr_avg = (vcr_avg - (vcr_avg >> 3)) + (vcr >> 3);
      // 系統安全監控 (軟體第二道防護)
      // vbus ovp
-      if (vbus > vbus_ovp)
+      if (vbus_avg > vbus_ovp)
      {
        sys_state = STATE_FAULT;
-        msg("%d %d %d %d \r\n", power_on_cmd, sys_state, vbus_comp_1, vbus_comp2);
-        // 1 6 196608, >> 9 = 384
        Power_Off();
      }
+#if 0
      // vac over voltage
-      /*
-       if (vac_pk2 > 2600)
-       {
-       sys_state = STATE_FAULT;
-       Power_Off();
-       }
-
-       // vac brown out
-       if (vac_pk2 < VOLT_BROWN_OUT && pfc_running == 1)
-       {
-       sys_state = STATE_FAULT;
-       Power_Off();
-       }
-       */
+      if (vac_pk2 > 2600)
+      {
+        sys_state = STATE_FAULT;
+        Power_Off();
+      }
+#endif
+#if 0
+      // vac brown out
+      if (vac_pk2 < VOLT_BROWN_OUT && pfc_running == 1)
+      {
+        sys_state = STATE_FAULT;
+        Power_Off();
+      }
+#endif
      Vac_Peak_Detector(); // VAC 峰值偵測

 #if 1
@@ -986,6 +1060,7 @@ int main(void)
          break;

        case STATE_PFC_SOFT_START: // 2
+                                   // 若 vbus < 320 做 pre-charge
          if (pfc_running == 0)
          {
            pfc_pwm_enable();
@@ -994,11 +1069,12 @@ int main(void)

          if (++v_loop_cnt >= 10) // 10KHZ
          {
-            Vol_Loop_PFC_1P1Z_UI();
+            Vol_Loop_PFC_1P1Z();
+            //Vol_Loop_PFC_1P1Z();
            v_loop_cnt = 0;
          }

-          if (vbus_avg > vbus_set_l)
+          if (vbus_avg > vbus_set_h)
          {
            sys_state = STATE_LLC_SOFT_START;
            llc_period_ss = LLC_SS_MIN;
@@ -1050,87 +1126,26 @@ int main(void)
            pfc_running = 1;
          }

-          /*
-          if (vbus_avg > vbus_set_h) {
-            TIM2->ARR = 1200; // 沒變??
-            msg("1\r\n");
-          }
-          else if (vbus_avg < vbus_set) {
-            TIM2->ARR = 600;
-            msg("2\r\n");
-          }
-           */
-
          if (++v_loop_cnt >= 10)
          {
            // 先算前饋，再算主環，最後疊加
-            // Load_Loop_1P1Z();	 // Cr 前饋
-            Vol_Loop_PFC_1P1Z_UI(); // PFC 電壓環
-            // Vol_Loop_LLC();     	 // LLC 電壓環
+            Load_Loop_1P1Z(); // Cr 前饋
+            Vol_Loop_PFC_1P1Z(); // PFC 電壓環
+            //Vol_Loop_LLC(); // LLC 電壓環
            v_loop_cnt = 0;
          }

-          /*
-          if (++v_loop_cnt2 >= 15) {
-            Vol_Loop_LLC();     	 // LLC 電壓環
+
+          if (++v_loop_cnt2 >= 5) // 好一點
+          {
+            Vol_Loop_LLC(); // LLC 電壓環
            v_loop_cnt2 = 0;
          }
-          */
+
+
          break;

        case STATE_RUN_SKIP: // 5
-          // SKIP 時電壓環控制DUTY
-          /*
-           if (++v_loop_cnt >= 10) // 10KHZ
-           {
-           Vol_Loop_PFC_1P1Z();
-           v_loop_cnt = 0;
-           }
-           */
-          // 1638400 >> 14 = 100 duty
-          // if (vbus_comp2 > 3000 && is_zero_crossing == 1) // back to normal run
-          if (vbus_avg < vbus_set_l && is_zero_crossing == 1) // back to normal run
-          {
-            sys_state = STATE_RUN_NORMAL;
-            // sys_state = STATE_PAUSE;	// 測試用
-            //  重要動作 =====================================
-            vbus_comp_1 = YN_MIN; // 假設從一個極小的係數開始
-            vbus_comp2 = (vbus_comp_1 >> 9);
-            vbus_err_1 = 0; // 清除誤差歷史
-            iac_err_2 = 0;
-            iac_err_1 = 0;
-            iac_comp_2 = YN_MIN;
-            iac_comp_1 = YN_MIN;
-          }
-
-          /* 有問題
-           // Brown-out 判斷
-           if (vac_pk2 < VAC_BROWN_OUT) {
-           brownout_cnt++;
-           if (brownout_cnt > BROWNOUT_DELAY) {
-           Power_Off();
-           sys_state = STATE_STANDBY;
-           }
-           }
-           else {
-           brownout_cnt = 0;
-           }
-           */
-          /* 先不做
-           // --- BURST / SKIP 邏輯 (帶滯後區間) ---
-           // 只在過零點判斷
-           if (is_zero_crossing == 1) {
-           if (vbus_avg > vbus_set_h) { // 上限觸發停機
-           pfc_pwm_disable();
-           burst_mode_active = 1;
-           }
-           else if (vbus_avg < vbus_set_l && burst_mode_active == 1) { // 下限觸發回復
-           reset_pid_parameters();
-           pfc_pwm_enable();
-           burst_mode_active = 0;
-           }
-           }
-           */
          break;

        case STATE_FAULT: // 6
@@ -1,5 +1,5 @@

-adapter speed 5000
+adapter speed 1000
 reset_config srst_only
 adapter srst pulse_width 100
Author	SHA1	Message	Date
aiden	c846ad9793	小改動	2026-06-10 11:36:25 +08:00
aiden	52e95c19c9	feat: 開啟Vol_Loop_LLC() 開啟 vac brown out protector	2026-05-28 11:35:52 +08:00
aiden	eee38b6a0c	feat: 電流環 ff_term tune done ff_term = (2800 - vac_avg1) * PFC_DUTY_MAX / 2800 - 200	2026-05-28 10:35:10 +08:00
aiden	86a8cbc5cf	feat: "單測 PFC 電流環" OK, 還沒有 ff_term Cur_Loop_PFC_2P2Z() OK vbus_comp2 = 1000 ff_term = 0	2026-05-27 17:28:29 +08:00
aiden	b20a622f5f	feat: "單測 PFC 電流環" 待測合適的值 vbus_comp2 = 3000 ff_term = 0 local_iac_set >> 12	2026-05-27 16:44:03 +08:00
aiden	8cdb477e0f	feat: 新增 "單測 PFC 電壓環" 參數	2026-05-27 15:38:58 +08:00
aiden	fe22085e48	feat :Vol_Loop_PFC_1P1Z_UI(), Vol_Loop_PFC_1P1Z() OK UI的電壓偏低	2026-05-27 15:34:13 +08:00
aiden	3ddf1079cb	feat: add .clang-format configuration for code styling	2026-05-27 15:01:52 +08:00