 
 void sendDataToPC() {
   if (deviceConnected) {
-    updateSensorsData();
     DataPacket dataPackage;
     dataPackage.accelerometerX = myIMU.ax;
     dataPackage.accelerometerY = myIMU.ay;

    while (1);
  }
  // Set accelerometers low pass filter at 5Hz
  I2CwriteByte(MPU9250_ADDRESS, 29, 0x06);
  // Set gyroscope low pass filter at 5Hz
  I2CwriteByte(MPU9250_ADDRESS, 26, 0x06);
  // Configure gyroscope range
  I2CwriteByte(MPU9250_ADDRESS, 27, GYRO_FULL_SCALE_250_DPS);
  // Configure accelerometers range

}

void setup() {
  ESP.wdtDisable();
  Wire.setClock(400000L);
  Wire.begin();
  Serial.begin(115200);
