     myCAM1.rdSensorReg16_8(OV5642_CHIPID_HIGH, &vid);
     myCAM1.rdSensorReg16_8(OV5642_CHIPID_LOW, &pid);
     if ((vid != 0x56) || (pid != 0x42)){
-      Serial.println(F("ACK CMD Can't find OV5642 module!"));
+      Serial.println(F("ACK CMD Can't find OV5642 module! END"));
       delay(1000);continue;
     }else{
-      Serial.println(F("ACK CMD OV5642 detected."));break;
+      Serial.println(F("ACK CMD OV5642 detected. END"));break;
     }    
   }  
 #endif

uint8_t temp;
Wire.begin(); 
Serial.begin(921600);
Serial.println(F("ArduCAM Start!")); 
// set the CS output:
pinMode(CS1, OUTPUT);
pinMode(CS2, OUTPUT);

    myCAM1.rdSensorReg16_8(OV5640_CHIPID_HIGH, &vid);
    myCAM1.rdSensorReg16_8(OV5640_CHIPID_LOW, &pid);
    if ((vid != 0x56) || (pid != 0x40)){
      Serial.println(F("ACK CMD Can't find OV5640 module! END"));
      delay(1000);continue;
    }else{
      Serial.println(F("ACK CMD OV5640 detected. END"));break;
    }    
  }
#else
