Index: Accel.c
===================================================================
diff -u -r212725dc2470b58e0a4b02276b46aa6b3040ebb7 -rf54e68e82b7a5bdd3c2510cd4cdced7e65d37746
--- Accel.c	(.../Accel.c)	(revision 212725dc2470b58e0a4b02276b46aa6b3040ebb7)
+++ Accel.c	(.../Accel.c)	(revision f54e68e82b7a5bdd3c2510cd4cdced7e65d37746)
@@ -625,6 +625,9 @@
        case ACCELEROMETER_SELF_TEST_STATE_IN_PROGRESS:
        {
            F32 vectorLen = calcVectorLength( accelAxes[ ACCEL_AXIS_X ].data, accelAxes[ ACCEL_AXIS_Y ].data, accelAxes[ ACCEL_AXIS_Z ].data );
+           vectorLen = calcVectorLength( getMeasuredAccelAxis( ACCEL_AXIS_X ),
+                                         getMeasuredAccelAxis( ACCEL_AXIS_Y ),
+                                         getMeasuredAccelAxis( ACCEL_AXIS_Z ) );
 
            if ( fabs( NOMINAL_ACCEL_VECTOR_LENGTH - vectorLen ) < MAX_ACCEL_VECTOR_LENGTH_ERROR )
            {