Test code
//www.ekostra.com
#include <Wire.h>
const int MPU6050_ADDR = 0x68; // MPU-6050 I2C address
int16_t accelerometer_x, accelerometer_y, accelerometer_z;
int16_t gyroscope_x, gyroscope_y, gyroscope_z;
void setup() {
Serial.begin(9600);
Wire.begin();
Wire.beginTransmission(MPU6050_ADDR);
Wire.write(0x6B); // PWR_MGMT_1 register
Wire.write(0); // Set to 0 to wake up the MPU-6050
Wire.endTransmission();
}
void loop() {
// Read accelerometer and gyroscope data
readMPU6050Data();
// Print the values
Serial.print("Accelerometer: ");
Serial.print("X = "); Serial.print(accelerometer_x);
Serial.print(", Y = "); Serial.println(accelerometer_y);
Serial.print(", Z = "); Serial.println(accelerometer_z);
//Serial.print("Gyroscope: ");
//Serial.print("X = "); Serial.print(gyroscope_x);
//Serial.print(", Y = "); Serial.print(gyroscope_y);
//Serial.print(", Z = "); Serial.println(gyroscope_z);
delay(20); // Delay for 1 second
}
void readMPU6050Data() {
Wire.beginTransmission(MPU6050_ADDR);
Wire.write(0x3B); // Starting register for accelerometer data
Wire.endTransmission(false);
Wire.requestFrom(MPU6050_ADDR, 14, true); // Request 14 bytes from MPU-6050
accelerometer_x = Wire.read() << 8 | Wire.read();
accelerometer_y = Wire.read() << 8 | Wire.read();
accelerometer_z = Wire.read() << 8 | Wire.read();
delay(100);
gyroscope_x = Wire.read() << 8 | Wire.read();
gyroscope_y = Wire.read() << 8 | Wire.read();
gyroscope_z = Wire.read() << 8 | Wire.read();
}
