|
|
@@ -1204,15 +1204,15 @@ int findMaxIndex(double arr[], int size) {
|
|
|
}
|
|
|
|
|
|
|
|
|
-void send_signal(void)
|
|
|
+void send_signal(int sig)
|
|
|
{
|
|
|
- rt_thread_kill(ctr_motor, SIGUSR1);
|
|
|
+ rt_thread_kill(ctr_motor, sig);
|
|
|
}
|
|
|
|
|
|
// 全局状态变量(需在合适位置初始化)
|
|
|
static float g_best_sharpness = -FLT_MAX; // 全局最佳清晰度
|
|
|
static int g_best_pos = 0; // 全局最佳位置
|
|
|
-static float g_last_sharpness = -FLT_MAX; // 上一次移动后的清晰度
|
|
|
+static float g_last_sharpness = 0.0; // 上一次移动后的清晰度
|
|
|
static bool g_initial_move = true; // 初始方向判断标志
|
|
|
static bool focus_done = false;
|
|
|
int maxIterations = 100;
|
|
|
@@ -1316,6 +1316,7 @@ void thread1_signal_handler(int sig)
|
|
|
|
|
|
LOG_I("[对焦] 最佳位置:%d (清晰度:%.2f)", g_best_pos, g_best_sharpness);
|
|
|
|
|
|
+
|
|
|
if(g_peak_counter>=3&¤t_sharpness>g_best_sharpness*0.95){
|
|
|
focus_done = true;
|
|
|
}else{
|
|
|
@@ -1347,7 +1348,7 @@ void thread1_signal_handler(int sig)
|
|
|
return;
|
|
|
}
|
|
|
}
|
|
|
-
|
|
|
+ slide_para.ystep = stepSize;
|
|
|
slide_para.ydir = dir;
|
|
|
slide_para.ydis = stepSize;
|
|
|
slide_para.en_slide = 6; // 触发移动
|
|
|
@@ -1357,15 +1358,77 @@ void thread1_signal_handler(int sig)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+void thread2_signal_handler(int sig)
|
|
|
+{
|
|
|
+ rt_timer_stop(timer_takephoto);
|
|
|
+ maxIterations--;
|
|
|
+ LOG_I("[Y] 清晰度值更新:%.2f", device_status.focus_value);
|
|
|
+ slide_para.pulse_period = mapSpeed(slide_para.pulse_period); // 更新电机速度参数
|
|
|
+ if(device_status.calibrate_slide==20&& maxIterations >= 0){
|
|
|
+ float current_sharpness = device_status.focus_value;
|
|
|
+ /* 更新全局最佳状态 */
|
|
|
+ if (current_sharpness > g_best_sharpness) {
|
|
|
+ g_best_sharpness = current_sharpness;
|
|
|
+ LOG_I("[Y] 发现更佳位置(清晰度:%.2f)",g_best_sharpness);
|
|
|
+ }
|
|
|
+ /* 初始方向判断(首步移动后) */
|
|
|
+ if (g_initial_move) {
|
|
|
+ if (current_sharpness > g_last_sharpness) {
|
|
|
+ LOG_I("[对焦] 初始方向正确,保持方向:%d", dir);
|
|
|
+ }
|
|
|
+ g_initial_move = false;
|
|
|
+ }else{
|
|
|
+ double diff_sharpness = fabs(current_sharpness-g_last_sharpness);
|
|
|
+ if(diff_sharpness<1.0)
|
|
|
+ {
|
|
|
+ counter_sharpness_diff++;
|
|
|
+ }
|
|
|
+
|
|
|
+ LOG_I("[Y] 清晰度变化累计%d次小于1.0",counter_sharpness_diff);
|
|
|
+ if(counter_sharpness_diff>1&&diff_sharpness>100.0){
|
|
|
+ //停止,保存当前位置
|
|
|
+ device_status.y_init_dis = slide_para.ystep;
|
|
|
+ LOG_I("设置Y轴初始位置:%d",slide_para.ystep);
|
|
|
+ ef_set_env_blob("y_init_dis", &device_status.y_init_dis, sizeof(device_status.y_init_dis));
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ /* 记录本次清晰度值 */
|
|
|
+ g_last_sharpness = current_sharpness;
|
|
|
+ }
|
|
|
+
|
|
|
+ /* 终止条件检测 */
|
|
|
+ if (maxIterations <= 0) {
|
|
|
+ device_status.calibrate_slide = 0;
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ slide_para.ydir = dir;
|
|
|
+ slide_para.ydis = 80;
|
|
|
+ slide_para.ystep += 80;
|
|
|
+ slide_para.en_slide = 6; // 触发移动
|
|
|
+ while (slide_para.en_slide != 0) {
|
|
|
+ rt_thread_delay(500); // 等待移动完成
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+}
|
|
|
+
|
|
|
|
|
|
//入口函数-电机控制及
|
|
|
static void Ctr_Mortor_entry(void* parameter)
|
|
|
{
|
|
|
/*孢子仪2.0*/
|
|
|
- rt_signal_install(SIGUSR1, thread1_signal_handler);
|
|
|
+ rt_signal_install(SIGUSR1, thread1_signal_handler); //自动对焦信号
|
|
|
+ rt_signal_install(SIGUSR2, thread2_signal_handler); //坐标校准信号
|
|
|
rt_signal_unmask(SIGUSR1);
|
|
|
+ rt_signal_unmask(SIGUSR2);
|
|
|
while(1)
|
|
|
{
|
|
|
+ if(device_status.calibrate_slide==2)
|
|
|
+ {
|
|
|
+ device_status.autotakepic=1;
|
|
|
+ device_status.calibrate_slide = 20;
|
|
|
+ }
|
|
|
+
|
|
|
/*对焦拍照,滑台初始化*/
|
|
|
if(device_status.autotakepic==1)
|
|
|
{
|
|
|
@@ -1403,7 +1466,24 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
rt_thread_delay(1000);
|
|
|
}
|
|
|
}
|
|
|
- device_status.autotakepic = 3;
|
|
|
+ if(device_status.calibrate_slide==0){
|
|
|
+ device_status.autotakepic = 3;
|
|
|
+ }else{
|
|
|
+ slide_para.en_slide = 7; //Y轴复位
|
|
|
+ slide_para.pulse_period = mapSpeed(50);
|
|
|
+ while(slide_para.en_slide!=0){
|
|
|
+ LOG_D("等待Y轴电机完成复位!");
|
|
|
+ rt_thread_delay(1000);
|
|
|
+ }
|
|
|
+ rt_thread_delay(1000);
|
|
|
+
|
|
|
+ //生成JSON指令
|
|
|
+ char *photo = makeJson_Warn("mov_init_y","takephoto_done");
|
|
|
+ DTU_Write("%s",photo);
|
|
|
+ rt_free(photo);
|
|
|
+ device_status.autotakepic = 4;
|
|
|
+ rt_timer_start(timer_takephoto);
|
|
|
+ }
|
|
|
}
|
|
|
if(device_status.autotakepic==3)
|
|
|
{
|
|
|
@@ -1442,7 +1522,7 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
dir = 1;
|
|
|
stepSize = 20; // 初始步长(单位:步进电机脉冲数)
|
|
|
current_pos = 0; // 根据实际类型修改(int/float等)
|
|
|
-
|
|
|
+ slide_para.ystep = 0;
|
|
|
g_peak_counter = 0;
|
|
|
g_last_rising = false;
|
|
|
focus_done = false;
|