zhunk 2 месяцев назад
Родитель
Сommit
6af850196f
1 измененных файлов с 15 добавлено и 19 удалено
  1. 15 19
      Application_cbd_apm32f1/applications/hmi.c

+ 15 - 19
Application_cbd_apm32f1/applications/hmi.c

@@ -308,7 +308,7 @@ static void auto_focus_process(void)
     /* 动态调整步长 */
     if (fabs(diff) > 3.0f) {
         /* 清晰度大幅变化 -> 缩小步长精细搜索 */
-        g_af.step_size = 4;
+        g_af.step_size = 10;
         g_af.diff_counter = 0;
         LOG_I("[对焦] 大幅变化,步长=%d", g_af.step_size);
     } else if (fabs(diff) < 1.0f) {
@@ -324,26 +324,22 @@ static void auto_focus_process(void)
 
     /* 方向判断 */
     bool need_reverse = false;
-    if (diff > 0.5f) {
-        /* 上升:保持方向,缩小步长逼近峰值 */
-        g_af.reduce_counter = 0;
+    if (current_sharpness > (g_af.last_sharpness - 3.5f)) { // 噪声容忍阈值3.0
+        // 保持方向,当接近峰值时自动减小步长
+        LOG_I("保持方向,当接近峰值时自动减小步长...");
         g_af.last_rising = true;
-        if (g_af.step_size > 4) g_af.step_size -= 2;
-        LOG_I("[对焦] 上升↑ 步长=%d", g_af.step_size);
-    } else if (diff < -0.3f) {
-        /* 下降:累计,超过阈值反转方向 */
-        g_af.reduce_counter++;
-        g_af.last_rising = false;
-        LOG_I("[对焦] 下降↓[%d/3]", g_af.reduce_counter);
-        if (g_af.reduce_counter >= 3) {
-            need_reverse = true;
-            g_af.reduce_counter = 0;
+        g_af.step_size = 10;
+    } else {
+        if(g_af.last_rising){
             g_af.peak_counter++;
-            LOG_I("[对焦] 峰值检测[%d/3]", g_af.peak_counter);
+            LOG_I("[对焦] 检测到清晰度波动[%d/2]", g_af.peak_counter);
+            g_af.step_size = 2;
+        }else {
+            g_af.peak_counter = 0;  // 连续下降则重置
         }
-    } else {
-        g_af.reduce_counter = 0;
-        LOG_I("[对焦] 平稳=");
+        g_af.last_rising = false;
+        g_af.dir = !g_af.dir;    // 清晰度下降,反转方向
+        LOG_I("[对焦] 清晰度下降,反转方向:%d 步长:%d", g_af.dir, g_af.step_size);
     }
 
     g_af.last_sharpness = current_sharpness;
@@ -365,7 +361,7 @@ static void auto_focus_process(void)
 
     /* 终止条件 */
     bool done = false;
-    if (g_af.peak_counter >= 3 && current_sharpness > g_af.best_sharpness * 0.95f) {
+    if (g_af.peak_counter >= 2 && current_sharpness > g_af.best_sharpness * 0.90f) {
         done = true;
         LOG_I("[对焦] 峰值确认完成");
         g_af.max_iterations = 100;