V2.1

src/SensorIS11.cpp

@@ -131,49 +131,38 @@ STRSensorInfo SensorIS11::GetSensorInfo()
     return setem;  
 }
 
-
 //shutter1 1关  2开
 void SensorIS11::SetShutter(int id)
 {
     switch (id) {
-        case 1:
-        { //关
-            // digitalWrite(5,LOW);
-
-            shutter_off();
+        case 1:{ //关
+            digitalWrite(5,LOW);
             vTaskDelay(200);
             break;
         }
-        case 2:
-        { //开
-            // digitalWrite(5,HIGH);
-            shutter_up();
+        case 2:{ //开
+            digitalWrite(5,HIGH);
             vTaskDelay(200);
             break;
         }
     }
 }
 
-
 //0下 1上
 void SensorIS11::servo_direction(int direction)
 {
     switch (direction) 
     {
         case 0:{ 
-
-            
-            shutter_down();
+            // servo_set_angle(12);
             servo_down();
-            vTaskDelay(500);
-            shutter_off();
+            vTaskDelay(1500);
             break;
         }
         case 1:{
-            shutter_up();
+            // servo_set_angle(200);
             servo_up();
-            vTaskDelay(500);
-            shutter_off();
+            vTaskDelay(1500);
             break;
         }
     }    
@@ -537,16 +526,32 @@ void SensorIS11::TakeOneJob()
     // write_log(log_path,"start",10);
 
     //1 opt_up
+#if SHUTTER_TYPE == 1
     servo_direction(1);
     SetShutter(2);
+#elif SHUTTER_TYPE == 2
+    shutter_up();
+#endif
+
     shutterup=OptSnenser(70);
     shutterdown = shutterup;
+    
+
+#if SHUTTER_TYPE == 1
     SetShutter(1);
+#elif SHUTTER_TYPE == 2
+    shutter_off();
+#endif
     work_progress = 30;
 
     //2 dark
     //dark_up
+#if SHUTTER_TYPE == 1
     SetShutter(1);
+#elif SHUTTER_TYPE == 2
+    shutter_up();
+#endif
+
     GetOneDate(shutterup);
     for (int i = 0; i < SensorInfo.BandNum;i++) 
     {
@@ -583,9 +588,16 @@ void SensorIS11::TakeOneJob()
     work_progress = 45;
    
     //3 dn_up
+#if SHUTTER_TYPE == 1
     SetShutter(2);
     GetOneDate(shutterup);
     SetShutter(1);
+#elif SHUTTER_TYPE == 2
+    shutter_up();
+    GetOneDate(shutterup);
+    shutter_off();
+#endif
+
     for (int i = 0; i < SensorInfo.BandNum;i++) 
     {
         IS11_datastruct_up.data[i] = DATABUFF[i];
@@ -605,10 +617,17 @@ void SensorIS11::TakeOneJob()
     work_progress = 60;
 
     //4 dn_down
+
+#if SHUTTER_TYPE == 1
     servo_direction(0);
     SetShutter(2);
-    GetOneDate(shutterup);
+    GetOneDate(shutterdown);
     SetShutter(1);
+#elif SHUTTER_TYPE == 2
+    shutter_down();
+    GetOneDate(shutterup);
+    shutter_off();
+#endif
     
     for (int i = 0; i < SensorInfo.BandNum;i++) {
         IS11_datastruct_down.data[i] = DATABUFF[i];