     else
     {
       NewSerial.write(0x20); // request telemetry
-      ReadTelemetry();
+      if(!ReadTelemetry()) return;
     }    
   
     while (!OSD.notInVSync());

static uint8_t recBytes = 0;
static uint32_t LastLoopTime = 0;

void ReadTelemetry()
{
  uint16_t i = 0;
  minBytes = 100;

           }
         }
      }
      else
      {
        return false;
      }
    }
  }
  return true;
}

static int16_t p_roll = 0;
