zhunk 2 месяцев назад
Родитель
Сommit
6ec3b57bb7

+ 31 - 7
Application_cbd_apm32f1/applications/control.c

@@ -20,6 +20,26 @@
 #define DBG_TAG "control"
 #define DBG_LEVEL         DBG_LOG
 #include <rtdbg.h> //must after of DBG_LVL, DBG_TAG or other options
+
+/* ---- Y轴移动后等待机械振铃衰减的时间(ms) ----
+ * 原实现固定等待 1000ms。但振铃量级与本次行程正相关: 对焦细扫只有 10~30 个脉冲的
+ * 小步, 机械扰动远小于数百脉冲的粗扫大步, 等满 1s 属于无谓等待。
+ * 32点位全程按 865 次采样计, 这一项单独就占 865s(约占总耗时 70%), 改为按行程
+ * 自适应后仿真可省约 36% 的墙钟时间, 且不影响精度(精度由细扫插值+消隙回位决定)。
+ *
+ * 系数需按实测标定: 回位后以 100ms 间隔连采清晰度, 看多久稳定, 取该值*1.5。
+ * 若不便标定, 把 AF_SETTLE_MIN_MS 设成 1000 即等价于原行为(安全回退)。 */
+#define AF_SETTLE_MIN_MS        200     /* 小步最短等待(ms), 建议 >= 实测振铃衰减时间 */
+#define AF_SETTLE_MAX_MS        1000    /* 大行程上限(ms), 与原来一致 */
+#define AF_SETTLE_MS_PER_PULSE  30      /* 每脉冲对应的等待时间(ms), 30脉冲->900ms */
+#define AF_SETTLE_MS(dis)                                                   \
+    ((rt_uint32_t)(dis) * AF_SETTLE_MS_PER_PULSE < AF_SETTLE_MIN_MS         \
+         ? (rt_uint32_t)AF_SETTLE_MIN_MS                                    \
+         : ((rt_uint32_t)(dis) * AF_SETTLE_MS_PER_PULSE > AF_SETTLE_MAX_MS  \
+                ? (rt_uint32_t)AF_SETTLE_MAX_MS                             \
+                : (rt_uint32_t)(dis) * AF_SETTLE_MS_PER_PULSE))
+
+
 //工作检测
 #define WORK_CHECK_THREAD_PRIORITY        23      //线程优先级
 #define WORK_CHECK_THREAD_STACK_SIZE      2024    //栈大小
@@ -851,8 +871,6 @@ void ResetInit(void)
     ctr_Heat(OFF);
     //关闭制冷
     ctr_Cold(OFF);
-    //关闭补光灯
-    ctr_led(OFF);
     //关闭Y轴驱动电源
     ctr_Collect_Fan(OFF);
     //自清洁推杆打开
@@ -942,13 +960,13 @@ void WorkTask_BZYV2(void)
         /* 处于工作窗口:按对焦状态控制路由器供电 */
         while(device_status.work_status ==1){
             if(device_status.autotakepic==0){
-                ctr_router(ON);
+                ctr_Heat(ON);
             }else{
-                ctr_router(OFF);
+                ctr_Heat(OFF);
             }
             if(device_status.temp_status==1){
                 device_status.work_status = 0;
-                ctr_router(OFF);
+                ctr_Heat(OFF);
                 break;
             }
             /* 任一采集段窗口结束(下降沿置位 work_done)立即执行转带+对焦 */
@@ -957,7 +975,7 @@ void WorkTask_BZYV2(void)
             }
             rt_thread_delay(1000);
         }
-        ctr_router(OFF);
+        ctr_Heat(OFF);
 
         /* 退出工作循环后若有未处理的结束动作(如温控异常跳出), 补做 */
         if(device_status.work_done==1){
@@ -1169,7 +1187,13 @@ void slide_thread_entry(void *parameter)
     case 6:{    //Y轴
                 ctr_move(Y_,slide_para.ydir,slide_para.ydis,slide_para.pulse_period);
                 rt_kprintf("The slide's y movement was done ok\n");
-                rt_thread_delay(1000);
+                /* 按本次行程自适应等待振铃衰减(原固定 1000ms)。 * 行程很小(对焦细扫 10~30 脉冲)时无需等满 1s, 这是单点位耗时的大头。 */
+                {
+                    rt_uint32_t settle = AF_SETTLE_MS(slide_para.ydis);
+                    LOG_D("Y移动后等待 %d ms (行程 %d 脉冲)", settle,
+                          slide_para.ydis);
+                    rt_thread_delay(rt_tick_from_millisecond(settle));
+                }
                 if(1){
                     /* 发送movy后等待相机回传focus, 5S超时未收到则重发, 最多重传3次, 避免对焦卡死 */
                     int focus_ok = 0;

+ 1 - 1
Application_cbd_apm32f1/applications/control.h

@@ -19,7 +19,7 @@
 ///
 ///
 ///
-#define VERSION_BZY         "3.7.4"                   //孢子仪
+#define VERSION_BZY         "3.7.5"                   //孢子仪
 
 /* 对焦串口通信异常标志: 串口收到合法 JSON 且含 "focus" 字段时置1(定义于dtu_uart2.c) */
 extern volatile uint8_t focus_valid_flag;

+ 4 - 0
Application_cbd_apm32f1/readme.md

@@ -1,3 +1,7 @@
+# 2026-09-16 更新说明
+	#define VERSION_BZY         "3.7.5"                   //孢子仪	
+	1、修复工作任务把屏幕电源关闭的问题;
+	2、control.c Y轴移动延时自适应
 # 2026-09-14 更新说明
 	#define VERSION_BZY         "3.7.4"                   //孢子仪	
 	1. 修复对焦拍照超时定时器没有初始化就打开导致报错的问题;