#include <Wire.h>
#include <MPU6050.h>

MPU6050 sensor;

int16_t sensors[5][6];  

void setup() {
  Serial.begin(9600);
  Wire.begin();
  
  sensor.initialize();

  if (sensor.testConnection()) {
    Serial.println("Sensor connected successfully");
  } else {
    Serial.println("Sensor connection failed");
  }
}

void loop() {

  int16_t ax, ay, az, gx, gy, gz;
  sensor.getAcceleration(&ax, &ay, &az);
  sensor.getRotation(&gx, &gy, &gz);

  for (int i = 0; i < 5; i++) {
    sensors[i][0] = ax + i * 10;
    sensors[i][1] = ay + i * 10;
    sensors[i][2] = az + i * 10;
    sensors[i][3] = gx + i * 10;
    sensors[i][4] = gy + i * 10;
    sensors[i][5] = gz + i * 10;
  }

  for (int i = 0; i < 5; i++) {
    ShowData(i);
  }

  delay(5000);
}

void ShowData(int Channel) {
  Serial.print("Sensor ");
  Serial.print(Channel);
  Serial.print(" | Acc: X=");
  Serial.print(sensors[Channel][0]); Serial.print(" Y=");
  Serial.print(sensors[Channel][1]); Serial.print(" Z=");
  Serial.print(sensors[Channel][2]);

  Serial.print(" | Gyro: X=");
  Serial.print(sensors[Channel][3]); Serial.print(" Y=");
  Serial.print(sensors[Channel][4]); Serial.print(" Z=");
  Serial.println(sensors[Channel][5]);
}