Lines Matching refs:grav
35 * @param[in] grav Gravity Vector (Body Frame), length 3
39 float inv_compass_angle(const long *compass, const long *grav, const float *quat)
46 cgcross[1] = (float)compass[1] * grav[2] - (float)compass[2] * grav[1];
47 cgcross[2] = (float)compass[2] * grav[0] - (float)compass[0] * grav[2];
48 cgcross[3] = (float)compass[0] * grav[1] - (float)compass[1] * grav[0];
698 void inv_get_cross_product_vec(float *cgcross, float compass[3], float grav[3]) {
700 cgcross[0] = (float)compass[1] * grav[2] - (float)compass[2] * grav[1];
701 cgcross[1] = (float)compass[2] * grav[0] - (float)compass[0] * grav[2];
702 cgcross[2] = (float)compass[0] * grav[1] - (float)compass[1] * grav[0];
