fix bugs in gyro implematation

lib/Sensors/sensorData.cpp

@@ -70,6 +70,7 @@ void SensorData::enableCalcCompass() {
 }
 
 void SensorData::enableGyroskop() {
+    this->gyroskop = new MPU6050();
     this->gyroskop->initialize();
     if (!this->gyroskop->testConnection()) {
         std::cout << "SensorData::enableGyroskop: Gyroskop is not conntected. Freeze!" << std::endl;

src/main.cpp

@@ -121,6 +121,7 @@ void setup() {
     sensorData = new SensorData();
     sensorData->enableGnss(spiPort, PinNumbers::gnssSpiCs);
     sensorData->enableRealCompass();
+    sensorData->enableGyroskop();
     driveManager = new DriveManager(&moveController, sensorData, controlPad->getControlPadDataPtr());
 
     outputBuf->activateMqtt(true);