[paparazzi-commits] [4672] added FLOAT_RATES_NORM

[antoine drouin]

Revision: 4672
          http://svn.sv.gnu.org/viewvc/?view=rev&root=paparazzi&revision=4672
Author:   poine
Date:     2010-03-12 23:50:11 +0000 (Fri, 12 Mar 2010)
Log Message:
-----------
added FLOAT_RATES_NORM

Modified Paths:
--------------
    paparazzi3/trunk/sw/airborne/math/pprz_algebra_float.h

Modified: paparazzi3/trunk/sw/airborne/math/pprz_algebra_float.h
===================================================================
--- paparazzi3/trunk/sw/airborne/math/pprz_algebra_float.h      2010-03-12 
20:39:46 UTC (rev 4671)
+++ paparazzi3/trunk/sw/airborne/math/pprz_algebra_float.h      2010-03-12 
23:50:11 UTC (rev 4672)
@@ -135,7 +135,9 @@
     RATES_ASSIGN(_r, 0., 0., 0.);              \
   }
 
+#define FLOAT_RATES_NORM(_v) (sqrtf((_v).p*(_v).p + (_v).q*(_v).q + 
(_v).r*(_v).r))
 
+
 /*
  * 3x3 matrices
  */