     mode = 2;
     temp = 0xff;
     start_capture = 2;
-    Serial.println(F("ACK CMD CAM start video streaming."));
+    Serial.println(F("ACK CMD CAM start video streaming. END"));
     break;
     case 0x30:
     mode = 3;
     temp = 0xff;
     start_capture = 3;
-    Serial.println(F("CAM start single shoot."));
+    Serial.println(F("ACK CMD CAM start single shoot. END"));
     break;
     case 0x31:
     temp = 0xff;

  Wire.begin();
  Serial.begin(921600);
#endif
Serial.println(F("ACK CMD ArduCAM Start!"));
// set the CS as an output:
pinMode(CS, OUTPUT);
// initialize SPI:

    myCAM.rdSensorReg8_8(OV2640_CHIPID_HIGH, &vid);
    myCAM.rdSensorReg8_8(OV2640_CHIPID_LOW, &pid);
    if ((vid != 0x26 ) && (( pid != 0x41 ) || ( pid != 0x42 ))){
      Serial.println(F("ACK CMD Can't find OV2640 module! END"));
      delay(1000);continue;
    }
    else{
      Serial.println(F("ACK CMD OV2640 detected. END"));break;
    } 
  }
#elif defined (OV3640_MINI_3MP)
