From 45516804b29adf365879eb181e2bfceadf9e402a Mon Sep 17 00:00:00 2001 From: s-p-4-r-k <8800076@gmail.com> Date: Tue, 27 Nov 2012 23:00:06 +0400 Subject: [PATCH 1/2] MAG fix for HK MultiWii 328P --- IMU.ino | 7 ++++++- 1 file changed, 6 insertions(+), 1 deletion(-) diff --git a/IMU.ino b/IMU.ino index 96a0279b..ef1121be 100644 --- a/IMU.ino +++ b/IMU.ino @@ -263,7 +263,12 @@ void getEstimatedAttitude(){ // Attitude of the cross product vector GxM heading = _atan2( EstG.V.X * EstM.V.Z - EstG.V.Z * EstM.V.X , EstG.V.Z * EstM.V.Y - EstG.V.Y * EstM.V.Z ); heading += MAG_DECLINIATION * 10; //add declination - heading = heading /10; + heading = heading / 10; + + #if defined(HK_MultiWii_328P) + heading -= 90; + #endif + if ( heading > 180) heading = heading - 360; else if (heading < -180) heading = heading + 360; #endif From 268355b53d6aa94c830c537fd915107c37e73272 Mon Sep 17 00:00:00 2001 From: s-p-4-r-k <8800076@gmail.com> Date: Tue, 27 Nov 2012 23:00:25 +0400 Subject: [PATCH 2/2] VBATPIN fix for HK MultiWii 328P --- def.h | 1 + 1 file changed, 1 insertion(+) diff --git a/def.h b/def.h index 3677e26f..66739d6d 100644 --- a/def.h +++ b/def.h @@ -955,6 +955,7 @@ #define GYRO_ORIENTATION(X, Y, Z){gyroADC[ROLL] = Y; gyroADC[PITCH] = -X; gyroADC[YAW] = -Z;} #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = X; magADC[PITCH] = Y; magADC[YAW] = -Z;} #undef INTERNAL_I2C_PULLUPS + #define V_BATPIN A7 #endif #if defined(CRIUS_AIO_PRO_V1)