My code is below, anyone tell me what's wrong or point me at an M5Core2 example?

#define M5STACK_MPU6886 

#define SDA 25
#define SCL 13

#include <M5Core2.h>
#include <Wire.h>
//TwoWire Wire1 = TwoWire(1);

#include <Adafruit_BMP085.h>
Adafruit_BMP085 bmp;

float pitch = 0.0F;
float roll  = 0.0F;
float yaw   = 0.0F;

//averages 
float pitcha = 0.0F;
float rolla  = 0.0F;
float yawa   = 0.0F;



  int i = 0;
  

void setup(){

  // Initialize the M5Stack object
  M5.begin();
  Wire.begin(SDA, SCL);  //M5Stack SDA, SC  
  //Wire1.begin(SDA, SCL, 400000);
  M5.IMU.Init();
  delay(200);
  M5.Lcd.fillScreen(BLACK);
  M5.Lcd.setTextColor(GREEN , BLACK);
  M5.Lcd.setTextSize(2);

     if (!bmp.begin()) {
      M5.Lcd.println("BMP Error");
   
        }

}

// the loop routine runs over and over again forever
void loop() {
    // put your main code here, to run repeatedly:1    

  M5.IMU.getAhrsData(&pitch,&roll,&yaw);
  
  pitcha += pitch;
  rolla += roll;
  yawa += yaw;
  
      if (i > 60) //average every i loops
        {
  
          pitch = pitcha/i;
          roll = (rolla/i)-90;
          yaw = yawa/i;
          
          pitcha = 0;
          rolla = 0;
          yawa = 0;
        
          i=0;
          
          M5.Lcd.setCursor(10, 20);
          M5.Lcd.printf(" Bank %3.0f   Pitch %3.0f   ", pitch, roll);
          M5.Lcd.println(bmp.readTemperature());
          
         }
  i++;
  delay(10);
}