working with R and 0's when no sensor present

arduino/Payload_BME280_MPU6050_STM32.ino

@@ -12,6 +12,7 @@ MPU6050 mpu6050(Wire);
 
 int counter = 0;
 long timer = 0;
+int bmePresent;
 
 void setup() {
 
@@ -26,9 +27,11 @@ void setup() {
     delay(50);              // wait for a second
     digitalWrite(PC13, HIGH);    // turn the LED off
 
-  if (!bme.begin(0x76)) {
+  if (bme.begin(0x76)) {
+    bmePresent = 1;
+  } else {
     Serial.println("Could not find a valid BME280 sensor, check wiring!");
-    while (1);
+    bmePresent = 0;
   }
   
   mpu6050.begin();
@@ -39,13 +42,18 @@ void loop() {
 
 #ifdef TESTING
   if (Serial.available() > 0) {
-    
     digitalWrite(PC13, LOW);   // turn the LED on
     delay(50);              // wait for a second
     digitalWrite(PC13, HIGH);    // turn the LED off
-
     char result = Serial.read();
-    //    Serial1.println(result);
+ //       Serial.println(result);  
+     
+    if (result == 'R') {
+      Serial.println("OK");
+      delay(500);
+      setup(); 
+    }
+    if (bmePresent) {
       Serial.print("OK BME280 ");
       Serial.print(bme.readTemperature());
       Serial.print(" ");
@@ -54,7 +62,10 @@ void loop() {
       Serial.print(bme.readAltitude(SEALEVELPRESSURE_HPA));
       Serial.print(" ");
       Serial.print(bme.readHumidity());
-    
+    } else
+    {
+       Serial.print("OK BME280 0.0 0.0 0.0 0.0");
+    }
     mpu6050.update();
     
     Serial.print(" MPU6050 ");
@@ -68,15 +79,18 @@ void loop() {
   }
 #else
   if (Serial1.available() > 0) {
-
     digitalWrite(PC13, LOW);   // turn the LED on
     delay(50);              // wait for a second
     digitalWrite(PC13, HIGH);    // turn the LED off
-
     char result = Serial1.read();
 //    Serial1.println(result);
-//    Serial1.println("OK ");
 
+    if (result == 'R') {
+      Serial1.println("OK");
+      delay(500);
+      setup(); 
+    }  
+    if (bmePresent) {  
       Serial1.print("OK BME280 ");
       Serial1.print(bme.readTemperature());
       Serial1.print(" ");
@@ -85,7 +99,10 @@ void loop() {
       Serial1.print(bme.readAltitude(SEALEVELPRESSURE_HPA));
       Serial1.print(" ");
       Serial1.print(bme.readHumidity());
-
+    } else
+    {
+       Serial1.print("OK BME280 0.0 0.0 0.0 0.0");
+    }
     mpu6050.update();
     
     Serial1.print(" MPU6050 ");