3 double eraEors(
double rnpb[3][3],
double s)
40 double x, ax, xs, ys, zs, p, q, eo;
44 ax = x / (1.0 + rnpb[2][2]);
46 ys = -ax * rnpb[2][1];
48 p = rnpb[0][0] * xs + rnpb[0][1] * ys + rnpb[0][2] * zs;
49 q = rnpb[1][0] * xs + rnpb[1][1] * ys + rnpb[1][2] * zs;
50 eo = ((p != 0) || (q != 0)) ? s - atan2(q, p) : s;
double eraEors(double rnpb[3][3], double s)