3 void eraPmpx(
double rc,
double dc,
double pr,
double pd,
4 double px,
double rv,
double pmt,
double pob[3],
60 double sr, cr, sd, cd, x, y, z, p[3], dt, pxr, w, pdz, pm[3];
72 dt = pmt +
eraPdp(p,pob)*AULTY;
78 pm[0] = - pr*y - pdz*cr + w*x;
79 pm[1] = pr*x - pdz*sr + w*y;
83 for (i = 0; i < 3; i++) {
84 p[
i] += dt*pm[
i] - pxr*pob[
i];
double eraPdp(double a[3], double b[3])
void eraPmpx(double rc, double dc, double pr, double pd, double px, double rv, double pmt, double pob[3], double pco[3])
void eraPn(double p[3], double *r, double u[3])