Home
last modified time | relevance | path

Searched refs:cos_err (Results 1 – 1 of 1) sorted by relevance

/device/google/contexthub/firmware/os/algos/
Dfusion.c566 float cos_err = vec3Dot(&aa, &unityA); in fusionHandleAcc() local
567 cos_err = cos_err < (1.f - ACC_COS_CONV_FACTOR) ? in fusionHandleAcc()
568 (1.f - ACC_COS_CONV_FACTOR) : cos_err; in fusionHandleAcc()
569 fc = (1.f - cos_err) * in fusionHandleAcc()
635 float cos_err = vec3Dot(&mm, &north); in fusionHandleMag() local
639 if (cos_err < (1.f - MAG_COS_CONV_FACTOR/4)) { in fusionHandleMag()
649 cos_err = cos_err < (1.f - MAG_COS_CONV_FACTOR) ? in fusionHandleMag()
650 (1.f - MAG_COS_CONV_FACTOR) : cos_err; in fusionHandleMag()
653 fc = (1.f - cos_err) * (1.0f / MAG_COS_CONV_FACTOR * MAG_COS_CONV_LIMIT); in fusionHandleMag()