|
|
@@ -1134,15 +1134,30 @@ static void auto_focus_fine_step(float current_sharpness)
|
|
|
* 落盘后再回 focus(清晰度), 收到即继续下一步 —— 两侧互相握手;
|
|
|
* 3) 全程记录最大清晰度位置: 清晰度出现过上升后, 连续下降 AF_LINEAR_FALL_STOP 步
|
|
|
* 判定已越过峰值, 结束扫描; 同时最多移动 AF_LINEAR_MAX_STEP 步(安全上限);
|
|
|
+ * 2026-11-09: 按现场要求改为"固定走满 AF_LINEAR_MAX_STEP(100) 步", 不再按清晰度
|
|
|
+ * 提前判越峰结束(AF_LINEAR_STOP_BY_SHARP=0)。清晰度仅用于记录最佳位置并回位。
|
|
|
* 4) 结束后回到最佳位置, 延时稳定后发 auto_focus 通知工控机对焦完成。
|
|
|
*
|
|
|
* 超时兜底: 复用 autotakepic==2 里的 focus 等待超时补发逻辑(AF_FOCUS_TIMEOUT_MS /
|
|
|
* AF_FOCUS_RETRY_MAX), 重试用尽则中止对焦、关灯、上报持续时间。
|
|
|
* 关闭本策略: 把 AF_LINEAR_EN 改成 0 即回到原来的多阶段爬山实现。 */
|
|
|
#define AF_LINEAR_EN 1 /* 1=线性步进扫描(默认) 0=原多阶段爬山 */
|
|
|
-#define AF_LINEAR_STEP 10 /* 每步移动脉冲数(1 tick = 1 脉冲, 固定 1kHz) */
|
|
|
+#define AF_LINEAR_STEP 40 /* 每步移动脉冲数(1 tick = 1 脉冲, 固定 1kHz) */
|
|
|
#define AF_LINEAR_FALL_STOP 10 /* 清晰度上升后连续下降该步数即判越峰结束 */
|
|
|
-#define AF_LINEAR_MAX_STEP 100 /* 单点位最多移动步数(防跑飞) */
|
|
|
+#define AF_LINEAR_MAX_STEP 100 /* 单点位最多移动步数(防跑飞); 关闭越峰判断时=固定步数 */
|
|
|
+/* 0 = 不按清晰度判断越峰, 固定走满 AF_LINEAR_MAX_STEP 步(现场要求)
|
|
|
+ * 1 = 原逻辑: 清晰度上升后连续下降 AF_LINEAR_FALL_STOP 步即提前结束 */
|
|
|
+#define AF_LINEAR_STOP_BY_SHARP 0
|
|
|
+/* ---- 清晰度波动检测(整段扫描结束后统计) ----
|
|
|
+ * 波动 = 本次扫描收到的清晰度最大值 - 最小值(极差)。
|
|
|
+ * 走完 100 步波动仍然 < AF_LINEAR_FLAT_TH, 说明整段几乎没有起伏:
|
|
|
+ * · 视场里没有可对焦的目标(空片/镜头被挡/镜头盖没开);
|
|
|
+ * · 或者相机/算法给出的清晰度是常数(数据链路异常)。
|
|
|
+ * 这时上报一条 warn 预警给平台, 由人工介入检查。
|
|
|
+ * 只有样本数够(>= AF_LINEAR_FLAT_MIN_SAMPLE)才判定, 避免 focus 大面积超时
|
|
|
+ * 导致"只收到两三个值"就误报。 */
|
|
|
+#define AF_LINEAR_FLAT_TH 100 /* 波动阈值: 极差小于该值即报预警 */
|
|
|
+#define AF_LINEAR_FLAT_MIN_SAMPLE 10 /* 至少收到这么多个清晰度才做判定 */
|
|
|
|
|
|
typedef struct {
|
|
|
bool active; /* 线性扫描进行中 */
|
|
|
@@ -1152,6 +1167,9 @@ typedef struct {
|
|
|
float best_sharp; /* 最佳清晰度 */
|
|
|
bool risen; /* 是否出现过清晰度上升 */
|
|
|
int fall_cnt; /* 上升之后的连续下降步数 */
|
|
|
+ int sample_cnt; /* 本次扫描收到的清晰度样本数 */
|
|
|
+ float sharp_min; /* 清晰度最小值(波动检测用) */
|
|
|
+ float sharp_max; /* 清晰度最大值(波动检测用) */
|
|
|
} af_linear_t;
|
|
|
|
|
|
static af_linear_t g_laf;
|
|
|
@@ -1201,12 +1219,51 @@ static void af_linear_step(void)
|
|
|
LOG_I("[线性对焦] 第%d步 位置=%d", g_laf.step_cnt, g_laf.pos);
|
|
|
}
|
|
|
|
|
|
-/* 收尾: 回最佳位置 -> 稳定延时 -> 上报 auto_focus */
|
|
|
+/* 清晰度波动检测: 走完全部步数后统计极差(max-min)
|
|
|
+ * · 极差 < AF_LINEAR_FLAT_TH 判定"整段没有起伏", 上报 warn 预警;
|
|
|
+ * · 样本太少(焦点回包大面积超时)不判定, 只打日志。
|
|
|
+ * 返回 true 表示已上报预警。 */
|
|
|
+static bool af_linear_check_flat(void)
|
|
|
+{
|
|
|
+ if (g_laf.sample_cnt < AF_LINEAR_FLAT_MIN_SAMPLE)
|
|
|
+ {
|
|
|
+ LOG_W("[线性对焦] 清晰度样本仅%d个, 不做波动判定", g_laf.sample_cnt);
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+
|
|
|
+ float range = g_laf.sharp_max - g_laf.sharp_min;
|
|
|
+ if (range >= (float)AF_LINEAR_FLAT_TH)
|
|
|
+ {
|
|
|
+ LOG_I("[线性对焦] 清晰度波动%.1f(>=%d) 正常, min=%.1f max=%.1f",
|
|
|
+ range, AF_LINEAR_FLAT_TH, g_laf.sharp_min, g_laf.sharp_max);
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+
|
|
|
+ LOG_W("[线性对焦] 清晰度波动过小: %.1f (<%d) min=%.1f max=%.1f 样本%d个",
|
|
|
+ range, AF_LINEAR_FLAT_TH, g_laf.sharp_min, g_laf.sharp_max,
|
|
|
+ g_laf.sample_cnt);
|
|
|
+
|
|
|
+ /* 上报预警: status 为描述(平台/工控机按"异常描述"展示), type 为部件名。
|
|
|
+ * 刻意不用 %f —— rt_sprintf 对浮点支持视配置而定, 这里转成整数展示。 */
|
|
|
+ char buf[64];
|
|
|
+ rt_sprintf(buf, "清晰度波动过小:%d(<%d) 共%d步",
|
|
|
+ (int)(range + 0.5f), AF_LINEAR_FLAT_TH, g_laf.sample_cnt);
|
|
|
+ char *wjs = makeJson_Warn(buf, "自动对焦");
|
|
|
+ if (wjs != RT_NULL) { DTU_Write("%s", wjs); rt_free(wjs); }
|
|
|
+ else { LOG_E("makeJson_Warn failed(清晰度波动过小)"); }
|
|
|
+
|
|
|
+ return true;
|
|
|
+}
|
|
|
+
|
|
|
+/* 收尾: 波动检测 -> 回最佳位置 -> 稳定延时 -> 上报 auto_focus */
|
|
|
static void af_linear_finish(void)
|
|
|
{
|
|
|
int back = g_laf.best_pos - g_laf.pos; /* >0 继续向下, <0 向上回退 */
|
|
|
g_laf.active = false;
|
|
|
|
|
|
+ /* 【100步清晰度波动检测】在回位之前统计, 不影响回位与 auto_focus 上报 */
|
|
|
+ af_linear_check_flat();
|
|
|
+
|
|
|
if (back != 0)
|
|
|
{
|
|
|
slide_para.pulse_period = AF_PWM_PERIOD_NS;
|
|
|
@@ -1229,13 +1286,21 @@ static void af_linear_init(void)
|
|
|
g_laf.active = true;
|
|
|
g_laf.best_sharp = -FLT_MAX;
|
|
|
g_laf.best_pos = 0;
|
|
|
+ /* 波动检测的初值: 最小值取最大, 最大值取最小 */
|
|
|
+ g_laf.sharp_min = FLT_MAX;
|
|
|
+ g_laf.sharp_max = -FLT_MAX;
|
|
|
|
|
|
g_af.active = true;
|
|
|
g_af.retry_cnt = 0;
|
|
|
g_af.wait_start_tick = rt_tick_get();
|
|
|
|
|
|
+#if AF_LINEAR_STOP_BY_SHARP
|
|
|
LOG_I("[线性对焦] 开始: 每步%d脉冲 最多%d步 上升后连降%d步结束",
|
|
|
AF_LINEAR_STEP, AF_LINEAR_MAX_STEP, AF_LINEAR_FALL_STOP);
|
|
|
+#else
|
|
|
+ LOG_I("[线性对焦] 开始: 每步%d脉冲 固定走满%d步(不按清晰度提前结束)",
|
|
|
+ AF_LINEAR_STEP, AF_LINEAR_MAX_STEP);
|
|
|
+#endif
|
|
|
|
|
|
/* 工控机收到 mov_init_y 后要打开录制文件才开始记帧, 这里留 300ms 让它就绪,
|
|
|
* 否则第一步的 movy 会赶在录制启动之前到达, 该位置的帧会被直接跳过 */
|
|
|
@@ -1252,6 +1317,11 @@ static void af_linear_process(void)
|
|
|
g_af.retry_cnt = 0;
|
|
|
g_af.wait_start_tick = rt_tick_get();
|
|
|
|
|
|
+ /* 波动检测采样: 记录本次扫描清晰度的最小值/最大值, 结束后算极差 */
|
|
|
+ g_laf.sample_cnt++;
|
|
|
+ if (current_sharpness < g_laf.sharp_min) g_laf.sharp_min = current_sharpness;
|
|
|
+ if (current_sharpness > g_laf.sharp_max) g_laf.sharp_max = current_sharpness;
|
|
|
+
|
|
|
if (current_sharpness > g_laf.best_sharp)
|
|
|
{
|
|
|
g_laf.best_sharp = current_sharpness;
|
|
|
@@ -1268,8 +1338,19 @@ static void af_linear_process(void)
|
|
|
g_laf.step_cnt, g_laf.pos, current_sharpness,
|
|
|
g_laf.best_sharp, g_laf.best_pos, g_laf.fall_cnt);
|
|
|
|
|
|
- if ((g_laf.risen && g_laf.fall_cnt >= AF_LINEAR_FALL_STOP) ||
|
|
|
- g_laf.step_cnt >= AF_LINEAR_MAX_STEP)
|
|
|
+ /* 结束条件:
|
|
|
+ * · 固定步数优先: 走满 AF_LINEAR_MAX_STEP(100) 步一定结束;
|
|
|
+ * · AF_LINEAR_STOP_BY_SHARP=1 时才允许"上升后连降 N 步"提前判越峰。 */
|
|
|
+ bool finish = (g_laf.step_cnt >= AF_LINEAR_MAX_STEP);
|
|
|
+#if AF_LINEAR_STOP_BY_SHARP
|
|
|
+ if (!finish && g_laf.risen && g_laf.fall_cnt >= AF_LINEAR_FALL_STOP)
|
|
|
+ {
|
|
|
+ LOG_I("[线性对焦] 第%d步 连降%d步, 判越峰提前结束",
|
|
|
+ g_laf.step_cnt, g_laf.fall_cnt);
|
|
|
+ finish = true;
|
|
|
+ }
|
|
|
+#endif
|
|
|
+ if (finish)
|
|
|
{
|
|
|
af_linear_finish();
|
|
|
return;
|
|
|
@@ -2131,6 +2212,38 @@ void ResetParamDefault(void)
|
|
|
ef_set_env_blob("ds", &device_status.ds, sizeof(device_status.ds));
|
|
|
rt_thread_delay(1000);
|
|
|
}
|
|
|
+/* 温湿度阈值默认值(与 ResetParamDefault 保持一致: 高温保护70℃ / 低温保护10℃)
|
|
|
+ * 单独定义成宏, 现场要改默认阈值只改这里 */
|
|
|
+#define SYS_RESET_TPH_DEFAULT 70
|
|
|
+#define SYS_RESET_TPL_DEFAULT 10
|
|
|
+
|
|
|
+/*----------------------------------------------------------------------------------
|
|
|
+ * 系统设置界面"参数重置"(工控机 ProfilePage -> 参数重置, JSONRPC method=factory_reset)
|
|
|
+ *
|
|
|
+ * 只重置两项, 其余参数(采集时段/上传间隔/胶带用量/对焦参数/开关机状态等)全部保持不变:
|
|
|
+ * 1) 系统工作时间: flashdb 里的 worked_day(累计已采集天数) 清零并落盘;
|
|
|
+ * 2) 温湿度阈值 : device_status.tph(高温保护) / tpl(低温保护) 恢复默认 70 / 10,
|
|
|
+ * 同时写回 env, 掉电不丢。
|
|
|
+ * 注意: 与 cmd "reset"(ResetParamDefault) 的"全参数恢复出厂"是两条不同路径,
|
|
|
+ * 后者会连采集时段、上传间隔一起恢复, 现场误用会把计划任务清掉。
|
|
|
+ *---------------------------------------------------------------------------------*/
|
|
|
+void SysParamReset_Partial(void)
|
|
|
+{
|
|
|
+ /* 1) 系统工作时间清零 */
|
|
|
+ flashdb_value.worked_day = 0;
|
|
|
+ /* worked_day 是 uint8_t, 必须显式传长度, 否则 app_flashdb_save 内部按指针宽度写会踩坏相邻字段 */
|
|
|
+ app_flashdb_save("worked_day", &flashdb_value.worked_day, sizeof(flashdb_value.worked_day));
|
|
|
+
|
|
|
+ /* 2) 温湿度阈值恢复默认 */
|
|
|
+ device_status.tph = SYS_RESET_TPH_DEFAULT; /* 高温保护 */
|
|
|
+ device_status.tpl = SYS_RESET_TPL_DEFAULT; /* 低温保护 */
|
|
|
+ ef_set_env_blob("tph", &device_status.tph, sizeof(device_status.tph));
|
|
|
+ ef_set_env_blob("tpl", &device_status.tpl, sizeof(device_status.tpl));
|
|
|
+
|
|
|
+ LOG_I("参数重置(部分): 系统工作时间 worked_day=%d, 温湿度阈值 tph=%d tpl=%d",
|
|
|
+ flashdb_value.worked_day, device_status.tph, device_status.tpl);
|
|
|
+}
|
|
|
+
|
|
|
void ResetParamDefault_DC(void)
|
|
|
{
|
|
|
//将温度数据设置为-15摄氏度,以便上传的数据中包含温控数据
|