#include <Wire.h>
#include <LSM6.h>

LSM6 imu;

void setup() {
  Serial.begin(115200);
  Wire.begin(1, 2);

  if (!imu.init()) {
    Serial.println("Falha ao detectar o LSM6!");
    while (1);
  }

  imu.enableDefault();
  Serial.println("LSM6DS33 inicializado com sucesso!");
}

void loop() {
  imu.read();

  Serial.print("Acel: ");
  Serial.print(imu.a.x); Serial.print('\t');
  Serial.print(imu.a.y); Serial.print('\t');
  Serial.print(imu.a.z); Serial.print('\n');

  Serial.print("Gyro: ");
  Serial.print(imu.g.x); Serial.print('\t');
  Serial.print(imu.g.y); Serial.print('\t');
  Serial.print(imu.g.z); Serial.print('\n');

  delay(500);
}