34 lines
649 B
C++
34 lines
649 B
C++
#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);
|
|
}
|