Searched refs:SF_STATE_DIM (Results 1 – 2 of 2) sorted by relevance
31 static void convertStateToCalStruct(const float x[SF_STATE_DIM],67 memset(&sphere_cal->x0[0], 0, sizeof(float) * SF_STATE_DIM); in sphereFitReset()153 float A[SF_STATE_DIM * THREE_AXIS_DIM]; in sphereFitResidAndJacobianFunc()155 memset(jacobian, 0, sizeof(float) * SF_STATE_DIM * data->num_fit_points); in sphereFitResidAndJacobianFunc()157 A[0 * SF_STATE_DIM + eParamOffset1] = -calstruct.scale_factor_x; in sphereFitResidAndJacobianFunc()158 A[1 * SF_STATE_DIM + eParamOffset2] = -calstruct.scale_factor_y; in sphereFitResidAndJacobianFunc()159 A[2 * SF_STATE_DIM + eParamOffset3] = -calstruct.scale_factor_z; in sphereFitResidAndJacobianFunc()191 A[1 * SF_STATE_DIM + eParamScaleMatrix21] = x_bias_corr[0]; in sphereFitResidAndJacobianFunc()192 A[1 * SF_STATE_DIM + eParamScaleMatrix22] = x_bias_corr[1]; in sphereFitResidAndJacobianFunc()193 A[2 * SF_STATE_DIM + eParamScaleMatrix31] = x_bias_corr[0]; in sphereFitResidAndJacobianFunc()[all …]
67 SF_STATE_DIM enumerator98 float x[SF_STATE_DIM];102 float x0[SF_STATE_DIM];