Exemplos de Gyro_init em C++ (Cpp)

Exemplo n.º 1

Arquivo: PSensors.cpp Projeto: sooyewguan/RobotChipKit

bool initSensors() {
#if defined(TRACE)
    Serial.println(">Start initSensors");
#endif

    i2c_init();
    delay(100);

    if (!MPU_init()) return false;
    if (!Gyro_init()) return false ;
    if (!ACC_init()) return false;

    f.I2C_INIT_DONE = 1;

#if defined(TRACE)
    Serial.println("<End OK initSensors");
#endif
    return true;
}

Exemplo n.º 2

Arquivo: PSensors.cpp Projeto: dangeljs/RobotChipKit

bool initSensors() {
#if defined(TRACE)	
  Serial.println(">>Start initSensors"); 
#endif 

  i2c_init();
  delay(100);
  
  if (!MPU_init())
  {   
#if defined(TRACE)	  
   Serial.println("<<End KO MPU_init");
#endif    
    return false;
  }
  if (!Gyro_init())
  {   
#if defined(TRACE)	  
   Serial.println("<<End KO Gyro_init");
#endif    
    return false;
  }    
  if (!ACC_init())
      {   
#if defined(TRACE)	  
   Serial.println("<<End KO ACC_init");
#endif    
    return false;
  }

  i2c_getTemperature(MPU6050_ADDRESS, 0x41);  
  imu.temperature  = (rawTemp[0] << 8) | rawTemp[1];
    
#if defined(TRACE)	  
  Serial.print("Temperature: "); Serial.println(((double)imu.temperature + 12412.0) / 340.0);
  Serial.println("<<End OK initSensors");
#endif 
  return true;
}