I also had a library problem thats fixed now.
arx// collect readings
accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
// apply gyro scale from datasheet
gsx = gx/gyroScale; gsy = gy/gyroScale; gsz = gz/gyroScale;
// calculate accelerometer angles
ary = -(180/3.141592) * atan(ax / sqrt(powsquare(ay, 2) + powsquare(az, 2)));
aryarx = (180/3.141592) * atan(ay / sqrt(powsquare(ax, 2) + powsquare(az, 2)));
arz = (180/3.141592) * atan(sqrt(square(ay) + square(ax)) / az);
// set initial values equal to accel values
if (i == 1) {
grx = arx;
gry = ary;
grz = arz;
}
// integrate to find the gyro angle
else{
grx = grx + (timeStep * gsx);
gry = gry + (timeStep * gsy);
grz = grz + (timeStep * gsz);
}
// apply filter
rx = (0.1 * arx) + (0.9 * grx);
ry = (0.1 * ary) + (0.9 * gry);
rz = (0.1 * arz) + (0.9 * grz);
Serial.print(ax); Serial.print("\t");
Serial.print(ay); Serial.print("\t");
Serial.print(az); Serial.print("\t\t");
Serial.print(gx); Serial.print("\t");
Serial.print(gy); Serial.print("\t");
Serial.print(gz); Serial.print("\t\t");
Serial.print(arx); Serial.print("\t");
Serial.print(ary); Serial.print("\t");
Serial.print(arz); Serial.print("\t\t");
Serial.print(grx); Serial.print("\t");
Serial.print(gry); Serial.print("\t");
Serial.print(grz); Serial.print("\t\t");
Serial.print(rx); Serial.print("\t");
Serial.print(ry); Serial.print("\t");
Serial.println(rz);
Here is the Arudino errors that im getting from Martin's code. Im not sure why i cant make it into code form....
In file included from MPU_6050.ino:4:C:\Users\marcus.hurtig\Documents\Arduino\libraries\MPU6050_6Axis_MotionApps20/MPU6050_6Axis_MotionApps20.h:34:27: error: helper_3dmath.h: No such file or directory
C:\Users\marcus.hurtig\Documents\Arduino\libraries\MPU6050_6Axis_MotionApps20/MPU6050_6Axis_MotionApps20.h:39:21: error: MPU6050.h: No such file or directory
In file included from MPU_6050.ino:4:
C:\Users\marcus.hurtig\Documents\Arduino\libraries\MPU6050_6Axis_MotionApps20/MPU6050_6Axis_MotionApps20.h:322: error: 'MPU6050' has not been declared
C:\Users\marcus.hurtig\Documents\Arduino\libraries\MPU6050_6Axis_MotionApps20/MPU6050_6Axis_MotionApps20.h: In function 'uint8_t dmpInitialize()':
And this continues for a while obviously.