Clarified comments around vector rotate method.

This commit is contained in:
Pierre Hugo 2015-01-21 19:26:28 -08:00
parent 6711c56dc5
commit fcdc0af218
1 changed files with 1 additions and 2 deletions

View File

@ -158,12 +158,11 @@ void normalizeV(struct fp_vector *src, struct fp_vector *dest)
}
}
// Rotate Estimated vector(s) with small angle approximation, according to the gyro data
// Rotate a vector *v by the euler angles defined by the 3-vector *delta.
void rotateV(struct fp_vector *v, fp_angles_t *delta)
{
struct fp_vector v_tmp = *v;
// This does a "proper" matrix rotation using gyro deltas without small-angle approximation
float mat[3][3];
float cosx, sinx, cosy, siny, cosz, sinz;
float coszcosx, sinzcosx, coszsinx, sinzsinx;