|
|
@@ -36,7 +36,7 @@
|
|
|
#define HMI_THREAD_STACK_SIZE 2048 //线程栈空间大小
|
|
|
#define HMI_THREAD_TIMESLICE 10 //时间片
|
|
|
|
|
|
-#define CONTROL_MOTOR_PRIORITY 18
|
|
|
+#define CONTROL_MOTOR_PRIORITY 7
|
|
|
#define CONTROL_MOTOR_STACK_SIZE 2048
|
|
|
#define CONTROL_MOTOR_TIMESLICE 10
|
|
|
|
|
|
@@ -1194,18 +1194,59 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
rt_uint8_t maxIndex = 0;
|
|
|
|
|
|
/*孢子仪2.0*/
|
|
|
- const int maxIterations = 30; // 最大迭代次数,可根据实际情况调整
|
|
|
- const int stepS = 1; // 对焦步长
|
|
|
+ const int maxIterations = 20; // 最大迭代次数,可根据实际情况调整
|
|
|
+ const int stepS = 2; // 对焦步长
|
|
|
double allSharpness[maxIterations]; // 当前图像清晰度评价值
|
|
|
char tmp_s[10];
|
|
|
char tmp[10];
|
|
|
while(1)
|
|
|
{
|
|
|
+ if(device_status.autotakepic==2){
|
|
|
+ memset(allSharpness,0,sizeof(allSharpness));
|
|
|
+ for(int i = 0; i < 3; i++){
|
|
|
+ slide_para.ydir = 1; //1位反向,0位正向;
|
|
|
+ slide_para.ydis = stepS;
|
|
|
+ slide_para.en_slide = 6;
|
|
|
+ while(slide_para.en_slide!=0)
|
|
|
+ {
|
|
|
+ rt_thread_delay(3000);
|
|
|
+ }
|
|
|
+ allSharpness[i] = device_status.focus_value;
|
|
|
+ }
|
|
|
+ //归位
|
|
|
+ for(int i = 3; i < 9; i++){
|
|
|
+ slide_para.ydir = 0; //1位反向,0位正向;
|
|
|
+ slide_para.ydis = stepS;
|
|
|
+ slide_para.en_slide = 6;
|
|
|
+ while(slide_para.en_slide!=0)
|
|
|
+ {
|
|
|
+ rt_thread_delay(3000);
|
|
|
+ }
|
|
|
+ if(i>=6) //过了初始位置再进行记录
|
|
|
+ allSharpness[i-3] = device_status.focus_value;
|
|
|
+ }
|
|
|
+ //检索最大清晰度位置
|
|
|
+ int max_i = findMaxIndex(allSharpness,6);
|
|
|
+
|
|
|
+ for(int i = 0; i < 6-max_i; i++){
|
|
|
+ slide_para.ydir = 1; //1位反向,0位正向;
|
|
|
+ slide_para.ydis = stepS;
|
|
|
+ slide_para.en_slide = 6;
|
|
|
+ while(slide_para.en_slide!=0)
|
|
|
+ {
|
|
|
+ rt_thread_delay(3000);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ char *photo_f = makeJson_Warn("auto_focus","focus_done");
|
|
|
+ DTU_Write("%s",photo_f);
|
|
|
+ rt_free(photo_f);
|
|
|
+ device_status.autotakepic = 0;
|
|
|
+ }
|
|
|
/*对焦拍照*/
|
|
|
if(device_status.autotakepic==1)
|
|
|
{
|
|
|
+ memset(allSharpness,0,sizeof(allSharpness));
|
|
|
device_status.step_focus = 1;
|
|
|
-
|
|
|
slide_para.en_slide =3; //X轴复位
|
|
|
while(slide_para.en_slide!=0){
|
|
|
LOG_D("等待X轴电机完成复位!");
|
|
|
@@ -1235,16 +1276,17 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
|
|
|
if(rt_pin_read(Limit_Motor_Y)==0){
|
|
|
slide_para.ydir = 1; //1位反向,0位正向;
|
|
|
- slide_para.ydis = 18000; //
|
|
|
+ slide_para.ydis = 8600; //
|
|
|
slide_para.en_slide = 6;
|
|
|
ctr_Cold(ON); //ctr_router(ON); 打开补光灯
|
|
|
while(slide_para.en_slide!=0){
|
|
|
LOG_D("等待Y轴电机完成移位:%d",slide_para.ydis);
|
|
|
- rt_thread_delay(1000);
|
|
|
+ rt_thread_delay(2000);
|
|
|
}
|
|
|
}
|
|
|
-
|
|
|
- //遍历所有位置
|
|
|
+#if 0
|
|
|
+ slide_para.pulse_period = 20; //修改滑台的脉宽为20ms
|
|
|
+ //遍历所有位置,粗对焦
|
|
|
for(int i = 0; i < maxIterations; i++){
|
|
|
slide_para.ydir = 0; //1位反向,0位正向;
|
|
|
slide_para.ydis = stepS;
|
|
|
@@ -1254,6 +1296,7 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
rt_thread_delay(2500);
|
|
|
}
|
|
|
allSharpness[i] = device_status.focus_value;
|
|
|
+ if(device_status.focus_value > 10.0) break;
|
|
|
}
|
|
|
for(int i = 0; i < maxIterations; i++){
|
|
|
sprintf(tmp_s, "%f",allSharpness[i]);
|
|
|
@@ -1261,6 +1304,7 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
}
|
|
|
maxIndex = findMaxIndex(allSharpness,maxIterations); //最大清晰度的位置
|
|
|
|
|
|
+
|
|
|
for(int i = 0; i < (maxIterations-maxIndex); i++){ //运动到该位置
|
|
|
slide_para.ydir = 1; //1位反向,0位正向;
|
|
|
slide_para.ydis = stepS;
|
|
|
@@ -1270,110 +1314,49 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
rt_thread_delay(2500);
|
|
|
}
|
|
|
}
|
|
|
-
|
|
|
-#if 0
|
|
|
- for(int i = 0; i < maxIterations; ++i){
|
|
|
- slide_para.ydir = 1; //1位反向,0位正向;
|
|
|
- slide_para.ydis = stepI;
|
|
|
- slide_para.en_slide = 6;
|
|
|
- while(slide_para.en_slide!=0)
|
|
|
- {
|
|
|
- rt_thread_delay(2500);
|
|
|
- }
|
|
|
- if(device_status.focus_value > allSharpness[maxIndex]){ //如果清晰度增大,继续前进
|
|
|
- allSharpness[maxIndex] = device_status.focus_value;
|
|
|
- }else{
|
|
|
- slide_para.ydir = 0; //1位反向,0位正向;
|
|
|
- slide_para.ydis = stepI;
|
|
|
- slide_para.en_slide = 6;
|
|
|
- while(slide_para.en_slide!=0)
|
|
|
- {
|
|
|
- rt_thread_delay(2500);
|
|
|
- }
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- for(int i = 0; i < maxIterations; ++i){
|
|
|
- slide_para.ydir = 0; //1位反向,0位正向;
|
|
|
- slide_para.ydis = stepI;
|
|
|
- slide_para.en_slide = 6;
|
|
|
- while(slide_para.en_slide!=0)
|
|
|
- {
|
|
|
- rt_thread_delay(2500);
|
|
|
- }
|
|
|
- if(device_status.focus_value > allSharpness[maxIndex]){ //如果清晰度增大,继续前进
|
|
|
- allSharpness[maxIndex] = device_status.focus_value;
|
|
|
- }else{
|
|
|
- slide_para.ydir = 1; //1位反向,0位正向;
|
|
|
- slide_para.ydis = stepI;
|
|
|
- slide_para.en_slide = 6;
|
|
|
- while(slide_para.en_slide!=0)
|
|
|
- {
|
|
|
- rt_thread_delay(2500);
|
|
|
- }
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
+ slide_para.pulse_period = 1; //修改滑台的脉宽为20ms
|
|
|
#endif
|
|
|
- // 在清晰度最佳的位置停止后,可以根据需要进行后续处理
|
|
|
-
|
|
|
- // 在清晰度最佳的位置停止后,可以根据需要进行后续处理
|
|
|
-// if(device_status.step_focus<5){
|
|
|
-// //粗对焦
|
|
|
|
|
|
-// }else{
|
|
|
-// maxIndex = device_status.step_focus;
|
|
|
-// }
|
|
|
-//
|
|
|
-// LOG_D("对焦最佳索引是:%d",maxIndex);
|
|
|
-// //粗对焦,滑台移动到清晰度最大的位置
|
|
|
-// for(int i = 0; i < maxIterations; i++){
|
|
|
-// //for(int i = 0; i < (maxIterations-maxIndex); i++){
|
|
|
-// //currentSharpness = device_status.focus_value;
|
|
|
+// //细对焦
|
|
|
+// memset(allSharpness,0,sizeof(allSharpness));
|
|
|
+// for(int i = 0; i < 3; i++){
|
|
|
// slide_para.ydir = 1; //1位反向,0位正向;
|
|
|
// slide_para.ydis = stepS;
|
|
|
// slide_para.en_slide = 6;
|
|
|
// while(slide_para.en_slide!=0)
|
|
|
// {
|
|
|
-// rt_thread_delay(2500);
|
|
|
+// rt_thread_delay(3000);
|
|
|
// }
|
|
|
-// //if ((arr[i] - arr[maxIndex])>EPS)
|
|
|
-// if((device_status.focus_value-allSharpness[maxIndex]) > EPS) break; //当前清晰度大于之前计算的清晰度位置
|
|
|
+// allSharpness[i] = device_status.focus_value;
|
|
|
// }
|
|
|
-// Sharpness_stepS = allSharpness[maxIndex];
|
|
|
-// memset(allSharpness,0,sizeof(allSharpness));
|
|
|
-
|
|
|
-
|
|
|
-
|
|
|
- //细对焦
|
|
|
-
|
|
|
-
|
|
|
-// #if 1
|
|
|
-// if(allSharpness[0]!=allSharpness[10])
|
|
|
-// {
|
|
|
-//
|
|
|
-
|
|
|
-// {//如果当前位置相比前一个位置清晰度减少,则返回到前一个位置,{之后再往前前位置运行,再对比清晰度}
|
|
|
-// //如果当前位置比前一个位置清晰度增大,继续前进,直到减少再返回前一个位置
|
|
|
-// if(device_status.focus_value-allSharpness[maxIndex] > EPS){ //清晰度增大
|
|
|
-//
|
|
|
-// slide_para.ydir = 0; //1位反向,0位正向;
|
|
|
-// slide_para.ydis = stepI;
|
|
|
-// slide_para.en_slide = 6;
|
|
|
-// while(slide_para.en_slide!=0)
|
|
|
-// {
|
|
|
-// rt_thread_delay(2000);
|
|
|
-// }
|
|
|
-// }else{
|
|
|
+// //归位
|
|
|
+// for(int i = 3; i < 9; i++){
|
|
|
+// slide_para.ydir = 0; //1位反向,0位正向;
|
|
|
+// slide_para.ydis = stepS;
|
|
|
+// slide_para.en_slide = 6;
|
|
|
+// while(slide_para.en_slide!=0)
|
|
|
+// {
|
|
|
+// rt_thread_delay(3000);
|
|
|
+// }
|
|
|
+// if(i>=6) //过了初始位置再进行记录
|
|
|
+// allSharpness[i-3] = device_status.focus_value;
|
|
|
+// }
|
|
|
+// //检索最大清晰度位置
|
|
|
+// int max_i= findMaxIndex(allSharpness,6);
|
|
|
//
|
|
|
+// for(int i = 0; i < 6-max_i; i++){
|
|
|
+// slide_para.ydir = 1; //1位反向,0位正向;
|
|
|
+// slide_para.ydis = stepS;
|
|
|
+// slide_para.en_slide = 6;
|
|
|
+// while(slide_para.en_slide!=0)
|
|
|
+// {
|
|
|
+// rt_thread_delay(3000);
|
|
|
// }
|
|
|
// }
|
|
|
-// #endif
|
|
|
|
|
|
//生成JSON指令
|
|
|
- sprintf(tmp, "%f",device_status.focus_value);
|
|
|
- char *photo = makeJson_Warn(tmp,"takephoto_done");
|
|
|
+ //sprintf(tmp, "%f",device_status.focus_value);
|
|
|
+ char *photo = makeJson_Warn("mov_init_y","takephoto_done");
|
|
|
DTU_Write("%s",photo);
|
|
|
rt_free(photo);
|
|
|
device_status.autotakepic = 0;
|
|
|
@@ -1387,10 +1370,10 @@ static void Ctr_Mortor_entry(void* parameter)
|
|
|
if(device_status.auto_test_sw==1)
|
|
|
{
|
|
|
//开始采集风机持续5S
|
|
|
- ctr_Cold(ON);
|
|
|
- rt_thread_delay(5000);
|
|
|
+ ctr_router(ON);
|
|
|
+ rt_thread_delay(1000*120);
|
|
|
//关闭采集风机
|
|
|
- ctr_Cold(OFF);
|
|
|
+ ctr_router(OFF);
|
|
|
//胶带传送
|
|
|
turnlimit();
|
|
|
//滑台归位,自动对焦
|