pitch and roll works well, but the yaw value "drift", and is not good orientated. When i only pitch the yaw value change, the same when i roll. When the Sensor is flat yaw works...
//MadgwickQuaternionUpdate(ax, ay, az, gx*PI/180.0f, gy*PI/180.0f, gz*PI/180.0f, mx, my, mz);
MadgwickQuaternionUpdate(ax, ay, -az, gx*PI/180.0f, gy*PI/180.0f, gz*PI/180.0f, my, mx, mz); // change mx & my, and negate az to have all axes in one direction!!!