Home
last modified time | relevance | path

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

/device/google/contexthub/firmware/src/algos/
Dfusion.c559 float cos_err = vec3Dot(&aa, &unityA); in fusionHandleAcc() local
560 cos_err = cos_err < (1.f - ACC_COS_CONV_FACTOR) ? in fusionHandleAcc()
561 (1.f - ACC_COS_CONV_FACTOR) : cos_err; in fusionHandleAcc()
562 fc = (1.f - cos_err) * in fusionHandleAcc()
618 float cos_err = vec3Dot(&mm, &north); in fusionHandleMag() local
619 cos_err = cos_err < (1.f - MAG_COS_CONV_FACTOR) ? in fusionHandleMag()
620 (1.f - MAG_COS_CONV_FACTOR) : cos_err; in fusionHandleMag()
623 fc = (1.f - cos_err) * (1.0f / MAG_COS_CONV_FACTOR * MAG_COS_CONV_LIMIT); in fusionHandleMag()