void iauLd(double bm, double p[3], double q[3], double e[3],
double em, double dlim, double p1[3])
/*
** - - - - - -
** i a u L d
** - - - - - -
**
** Apply light deflection by a solar-system body, as part of
** transforming coordinate direction into natural direction.
**
** This function is part of the International Astronomical Union's
** SOFA (Standards of Fundamental Astronomy) software collection.
**
** Status: support function.
**
** Given:
** bm double mass of the gravitating body (solar masses)
** p double[3] direction from observer to source (unit vector)
** q double[3] direction from body to source (unit vector)
** e double[3] direction from body to observer (unit vector)
** em double distance from body to observer (au)
** dlim double deflection limiter (Note 4)
**
** Returned:
** p1 double[3] observer to deflected source (unit vector)
**
** Notes:
**
** 1) The algorithm is based on Expr. (70) in Klioner (2003) and
** Expr. (7.63) in the Explanatory Supplement (Urban & Seidelmann
** 2013), with some rearrangement to minimize the effects of machine
** precision.
**
** 2) The mass parameter bm can, as required, be adjusted in order to
** allow for such effects as quadrupole field.
**
** 3) The barycentric position of the deflecting body should ideally
** correspond to the time of closest approach of the light ray to
** the body.
**
** 4) The deflection limiter parameter dlim is phi^2/2, where phi is
** the angular separation (in radians) between source and body at
** which limiting is applied. As phi shrinks below the chosen
** threshold, the deflection is artificially reduced, reaching zero
** for phi = 0.
**
** 5) The returned vector p1 is not normalized, but the consequential
** departure from unit magnitude is always negligible.
**
** 6) The arguments p and p1 can be the same array.
**
** 7) To accumulate total light deflection taking into account the
** contributions from several bodies, call the present function for
** each body in succession, in decreasing order of distance from the
** observer.
**
** 8) For efficiency, validation is omitted. The supplied vectors must
** be of unit magnitude, and the deflection limiter non-zero and
** positive.
**
** References:
**
** Urban, S. & Seidelmann, P. K. (eds), Explanatory Supplement to
** the Astronomical Almanac, 3rd ed., University Science Books
** (2013).
**
** Klioner, Sergei A., "A practical relativistic model for micro-
** arcsecond astrometry in space", Astr. J. 125, 1580-1597 (2003).
**
** Called:
** iauPdp scalar product of two p-vectors
** iauPxp vector product of two p-vectors
**
** This revision: 2013 October 9
**
** SOFA release 2015-02-09
**
** Copyright (C) 2015 IAU SOFA Board. See notes at end.
*/
{
int i;
double qpe[3], qdqpe, w, eq[3], peq[3];
/* q . (q + e). */
for (i = 0; i < 3; i++) {
qpe[i] = q[i] + e[i];
}
qdqpe = iauPdp(q, qpe);
/* 2 x G x bm / ( em x c^2 x ( q . (q + e) ) ). */
w = bm * SRS / em / gmax(qdqpe,dlim);
/* p x (e x q). */
iauPxp(e, q, eq);
iauPxp(p, eq, peq);
/* Apply the deflection. */
for (i = 0; i < 3; i++) {
p1[i] = p[i] + w*peq[i];
}
/* Finished. */
/*----------------------------------------------------------------------
**
** Copyright (C) 2015
** Standards Of Fundamental Astronomy Board
** of the International Astronomical Union.
**
** =====================
** SOFA Software License
** =====================
**
** NOTICE TO USER:
**
** BY USING THIS SOFTWARE YOU ACCEPT THE FOLLOWING SIX TERMS AND
** CONDITIONS WHICH APPLY TO ITS USE.
**
** 1. The Software is owned by the IAU SOFA Board ("SOFA").
**
** 2. Permission is granted to anyone to use the SOFA software for any
** purpose, including commercial applications, free of charge and
** without payment of royalties, subject to the conditions and
** restrictions listed below.
**
** 3. You (the user) may copy and distribute SOFA source code to others,
** and use and adapt its code and algorithms in your own software,
** on a world-wide, royalty-free basis. That portion of your
** distribution that does not consist of intact and unchanged copies
** of SOFA source code files is a "derived work" that must comply
** with the following requirements:
**
** a) Your work shall be marked or carry a statement that it
** (i) uses routines and computations derived by you from
** software provided by SOFA under license to you; and
** (ii) does not itself constitute software provided by and/or
** endorsed by SOFA.
**
** b) The source code of your derived work must contain descriptions
** of how the derived work is based upon, contains and/or differs
** from the original SOFA software.
**
** c) The names of all routines in your derived work shall not
** include the prefix "iau" or "sofa" or trivial modifications
** thereof such as changes of case.
**
** d) The origin of the SOFA components of your derived work must
** not be misrepresented; you must not claim that you wrote the
** original software, nor file a patent application for SOFA
** software or algorithms embedded in the SOFA software.
**
** e) These requirements must be reproduced intact in any source
** distribution and shall apply to anyone to whom you have
** granted a further right to modify the source code of your
** derived work.
**
** Note that, as originally distributed, the SOFA software is
** intended to be a definitive implementation of the IAU standards,
** and consequently third-party modifications are discouraged. All
** variations, no matter how minor, must be explicitly marked as
** such, as explained above.
**
** 4. You shall not cause the SOFA software to be brought into
** disrepute, either by misuse, or use for inappropriate tasks, or
** by inappropriate modification.
**
** 5. The SOFA software is provided "as is" and SOFA makes no warranty
** as to its use or performance. SOFA does not and cannot warrant
** the performance or results which the user may obtain by using the
** SOFA software. SOFA makes no warranties, express or implied, as
** to non-infringement of third party rights, merchantability, or
** fitness for any particular purpose. In no event will SOFA be
** liable to the user for any consequential, incidental, or special
** damages, including any lost profits or lost savings, even if a
** SOFA representative has been advised of such damages, or for any
** claim by any third party.
**
** 6. The provision of any version of the SOFA software under the terms
** and conditions specified herein does not imply that future
** versions will also be made available under the same terms and
** conditions.
*
** In any published work or commercial product which uses the SOFA
** software directly, acknowledgement (see www.iausofa.org) is
** appreciated.
**
** Correspondence concerning SOFA software should be addressed as
** follows:
**
** By email: [email protected]
** By post: IAU SOFA Center
** HM Nautical Almanac Office
** UK Hydrographic Office
** Admiralty Way, Taunton
** Somerset, TA1 2DN
** United Kingdom
**
**--------------------------------------------------------------------*/
}
void mexFunction(int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[]) {
size_t numRow,numVec;
mxArray *retMat;
double *xVec, *retData;
double TT1, TT2, UT11, UT12;
//The if-statements below should properly initialize all of the EOP.
//The following initializations to zero are to suppress warnings when
//compiling with -Wconditional-uninitialized.
double dX=0;
double dY=0;
double deltaT=0;
double LOD=0;
double GCRS2TIRS[3][3];
//Polar motion matrix. ITRS=POM*TIRS. We will just be setting it to the
//identity matrix as polar motion is not taken into account when going
//to the TIRS.
double rident[3][3]={{1,0,0},{0,1,0},{0,0,1}};
double Omega[3];//The rotation vector in the TIRS
if(nrhs<3||nrhs>6){
mexErrMsgTxt("Wrong number of inputs");
}
if(nlhs>2) {
mexErrMsgTxt("Wrong number of outputs.");
}
checkRealDoubleArray(prhs[0]);
numRow = mxGetM(prhs[0]);
numVec = mxGetN(prhs[0]);
if(!(numRow==3||numRow==6)) {
mexErrMsgTxt("The input vector has a bad dimensionality.");
}
xVec=(double*)mxGetData(prhs[0]);
TT1=getDoubleFromMatlab(prhs[1]);
TT2=getDoubleFromMatlab(prhs[2]);
//If some values from the function getEOP will be needed
if(nrhs<=5||mxIsEmpty(prhs[3])||mxIsEmpty(prhs[4])||mxIsEmpty(prhs[5])) {
mxArray *retVals[5];
double *dXdY;
mxArray *JulUTCMATLAB[2];
double JulUTC[2];
int retVal;
//Get the time in UTC to look up the parameters by going to TAI and
//then UTC.
retVal=iauTttai(TT1, TT2, &JulUTC[0], &JulUTC[1]);
if(retVal!=0) {
mexErrMsgTxt("An error occurred computing TAI.");
}
retVal=iauTaiutc(JulUTC[0], JulUTC[1], &JulUTC[0], &JulUTC[1]);
switch(retVal){
case 1:
mexWarnMsgTxt("Dubious Date entered.");
break;
case -1:
mexErrMsgTxt("Unacceptable date entered");
break;
default:
break;
}
JulUTCMATLAB[0]=doubleMat2Matlab(&JulUTC[0],1,1);
JulUTCMATLAB[1]=doubleMat2Matlab(&JulUTC[1],1,1);
//Get the Earth orientation parameters for the given date.
mexCallMATLAB(5,retVals,2,JulUTCMATLAB,"getEOP");
mxDestroyArray(JulUTCMATLAB[0]);
mxDestroyArray(JulUTCMATLAB[1]);
//%We do not need the polar motion coordinates.
mxDestroyArray(retVals[0]);
checkRealDoubleArray(retVals[1]);
if(mxGetM(retVals[1])!=2||mxGetN(retVals[1])!=1) {
mxDestroyArray(retVals[1]);
mxDestroyArray(retVals[2]);
mxDestroyArray(retVals[3]);
mxDestroyArray(retVals[4]);
mexErrMsgTxt("Error using the getEOP function.");
return;
}
dXdY=(double*)mxGetData(retVals[1]);
dX=dXdY[0];
dY=dXdY[1];
//This is TT-UT1
deltaT=getDoubleFromMatlab(retVals[3]);
LOD=getDoubleFromMatlab(retVals[4]);
//Free the returned arrays.
mxDestroyArray(retVals[1]);
mxDestroyArray(retVals[2]);
mxDestroyArray(retVals[3]);
mxDestroyArray(retVals[4]);
}
//If deltaT=TT-UT1 is given
if(nrhs>3&&!mxIsEmpty(prhs[3])) {
deltaT=getDoubleFromMatlab(prhs[3]);
}
//Obtain UT1 from terestrial time and deltaT.
iauTtut1(TT1, TT2, deltaT, &UT11, &UT12);
//Get celestial pole offsets, if given.
if(nrhs>4&&!mxIsEmpty(prhs[4])) {
size_t dim1, dim2;
checkRealDoubleArray(prhs[4]);
dim1 = mxGetM(prhs[4]);
dim2 = mxGetN(prhs[4]);
if((dim1==2&&dim2==1)||(dim1==1&&dim2==2)) {
double *dXdY=(double*)mxGetData(prhs[4]);
dX=dXdY[0];
dY=dXdY[1];
} else {
mexErrMsgTxt("The celestial pole offsets have the wrong dimensionality.");
return;
}
}
//If LOD is given
if(nrhs>5&&mxIsEmpty(prhs[5])) {
LOD=getDoubleFromMatlab(prhs[5]);
}
//Compute the rotation matrix for going from GCRS to ITRS as well as
//the instantaneous vector angular momentum due to the Earth's rotation
//in TIRS coordinates.
{
double x, y, s, era;
double rc2i[3][3];
double omega;
//Get the X,Y coordinates of the Celestial Intermediate Pole (CIP) and
//the Celestial Intermediate Origin (CIO) locator s, using the IAU 2006
//precession and IAU 2000A nutation models.
iauXys06a(TT1, TT2, &x, &y, &s);
//Add the CIP offsets.
x += dX;
y += dY;
//Get the GCRS-to-CIRS matrix
iauC2ixys(x, y, s, rc2i);
//Find the Earth rotation angle for the given UT1 time.
era = iauEra00(UT11, UT12);
//Set the polar motion matrix to the identity matrix so that the
//conversion stops at the TIRS instead of the ITRS.
//Combine the GCRS-to-CIRS matrix, the Earth rotation angle, and use
//the identity matrix instead of the polar motion matrix to get a
//to get the rotation matrix to go from GCRS to TIRS.
iauC2tcio(rc2i, era, rident,GCRS2TIRS);
//Next, to be able to transform the velocity, the rotation of the Earth
//has to be taken into account.
//The angular velocity vector of the Earth in the TIRS in radians.
omega=getScalarMatlabClassConst("Constants","IERSMeanEarthRotationRate");
//Adjust for LOD
omega=omega*(1-LOD/86400.0);//86400.0 is the number of seconds in a TT
//day.
Omega[0]=0;
Omega[1]=0;
Omega[2]=omega;
}
//Allocate space for the return vectors.
retMat=mxCreateDoubleMatrix(numRow,numVec,mxREAL);
retData=(double*)mxGetData(retMat);
{
size_t curVec;
for(curVec=0;curVec<numVec;curVec++) {
//Multiply the position vector with the rotation matrix.
iauRxp(GCRS2TIRS, xVec+numRow*curVec, retData+numRow*curVec);
//If a velocity vector was given.
if(numRow>3) {
double *posGCRS=xVec+numRow*curVec;
double posTIRS[3];
double *velGCRS=xVec+numRow*curVec+3;//Velocity in GCRS
double velTIRS[3];
double *retDataVel=retData+numRow*curVec+3;
double rotVel[3];
//If a velocity was provided with the position, first
//convert to TIRS coordinates, then account for the
//rotation of the Earth.
//Convert velocity from GCRS to TIRS.
iauRxp(GCRS2TIRS, velGCRS, velTIRS);
//Convert position from GCRS to TIRS
iauRxp(GCRS2TIRS, posGCRS, posTIRS);
//Evaluate the cross product for the angular velocity due
//to the Earth's rotation.
iauPxp(Omega, posTIRS, rotVel);
//Subtract out the instantaneous velocity due to rotation.
iauPmp(velTIRS, rotVel, retDataVel);
}
}
}
plhs[0]=retMat;
//If the rotation matrix is desired on the output.
if(nlhs>1) {
double *elPtr;
size_t i,j;
plhs[1]=mxCreateDoubleMatrix(3,3,mxREAL);
elPtr=(double*)mxGetData(plhs[1]);
for (i=0;i<3;i++) {
for(j=0;j<3;j++) {
elPtr[i+3*j]=GCRS2TIRS[i][j];
}
}
}
}
void iauHfk5z(double rh, double dh, double date1, double date2,
double *r5, double *d5, double *dr5, double *dd5)
/*
** - - - - - - - - -
** i a u H f k 5 z
** - - - - - - - - -
**
** Transform a Hipparcos star position into FK5 J2000.0, assuming
** zero Hipparcos proper motion.
**
** This function is part of the International Astronomical Union's
** SOFA (Standards Of Fundamental Astronomy) software collection.
**
** Status: support function.
**
** Given:
** rh double Hipparcos RA (radians)
** dh double Hipparcos Dec (radians)
** date1,date2 double TDB date (Note 1)
**
** Returned (all FK5, equinox J2000.0, date date1+date2):
** r5 double RA (radians)
** d5 double Dec (radians)
** dr5 double FK5 RA proper motion (rad/year, Note 4)
** dd5 double Dec proper motion (rad/year, Note 4)
**
** Notes:
**
** 1) The TT date date1+date2 is a Julian Date, apportioned in any
** convenient way between the two arguments. For example,
** JD(TT)=2450123.7 could be expressed in any of these ways,
** among others:
**
** date1 date2
**
** 2450123.7 0.0 (JD method)
** 2451545.0 -1421.3 (J2000 method)
** 2400000.5 50123.2 (MJD method)
** 2450123.5 0.2 (date & time method)
**
** The JD method is the most natural and convenient to use in
** cases where the loss of several decimal digits of resolution
** is acceptable. The J2000 method is best matched to the way
** the argument is handled internally and will deliver the
** optimum resolution. The MJD method and the date & time methods
** are both good compromises between resolution and convenience.
**
** 2) The proper motion in RA is dRA/dt rather than cos(Dec)*dRA/dt.
**
** 3) The FK5 to Hipparcos transformation is modeled as a pure rotation
** and spin; zonal errors in the FK5 catalogue are not taken into
** account.
**
** 4) It was the intention that Hipparcos should be a close
** approximation to an inertial frame, so that distant objects have
** zero proper motion; such objects have (in general) non-zero
** proper motion in FK5, and this function returns those fictitious
** proper motions.
**
** 5) The position returned by this function is in the FK5 J2000.0
** reference system but at date date1+date2.
**
** 6) See also iauFk52h, iauH2fk5, iauFk5zhz.
**
** Called:
** iauS2c spherical coordinates to unit vector
** iauFk5hip FK5 to Hipparcos rotation and spin
** iauRxp product of r-matrix and p-vector
** iauSxp multiply p-vector by scalar
** iauRxr product of two r-matrices
** iauTrxp product of transpose of r-matrix and p-vector
** iauPxp vector product of two p-vectors
** iauPv2s pv-vector to spherical
** iauAnp normalize angle into range 0 to 2pi
**
** Reference:
**
** F.Mignard & M.Froeschle, 2000, Astron.Astrophys. 354, 732-739.
**
** This revision: 2013 June 18
**
** SOFA release 2013-12-02
**
** Copyright (C) 2013 IAU SOFA Board. See notes at end.
*/
{
double t, ph[3], r5h[3][3], s5h[3], sh[3], vst[3],
rst[3][3], r5ht[3][3], pv5e[2][3], vv[3],
w, r, v;
/* Time interval from fundamental epoch J2000.0 to given date (JY). */
t = ((date1 - DJ00) + date2) / DJY;
/* Hipparcos barycentric position vector (normalized). */
iauS2c(rh, dh, ph);
/* FK5 to Hipparcos orientation matrix and spin vector. */
iauFk5hip(r5h, s5h);
/* Rotate the spin into the Hipparcos system. */
iauRxp(r5h, s5h, sh);
/* Accumulated Hipparcos wrt FK5 spin over that interval. */
iauSxp(t, s5h, vst);
/* Express the accumulated spin as a rotation matrix. */
iauRv2m(vst, rst);
/* Rotation matrix: accumulated spin, then FK5 to Hipparcos. */
iauRxr(r5h, rst, r5ht);
/* De-orient & de-spin the Hipparcos position into FK5 J2000.0. */
iauTrxp(r5ht, ph, pv5e[0]);
/* Apply spin to the position giving a space motion. */
iauPxp(sh, ph, vv);
/* De-orient & de-spin the Hipparcos space motion into FK5 J2000.0. */
iauTrxp(r5ht, vv, pv5e[1]);
/* FK5 position/velocity pv-vector to spherical. */
iauPv2s(pv5e, &w, d5, &r, dr5, dd5, &v);
*r5 = iauAnp(w);
return;
/*----------------------------------------------------------------------
**
** Copyright (C) 2013
** Standards Of Fundamental Astronomy Board
** of the International Astronomical Union.
**
** =====================
** SOFA Software License
** =====================
**
** NOTICE TO USER:
**
** BY USING THIS SOFTWARE YOU ACCEPT THE FOLLOWING SIX TERMS AND
** CONDITIONS WHICH APPLY TO ITS USE.
**
** 1. The Software is owned by the IAU SOFA Board ("SOFA").
**
** 2. Permission is granted to anyone to use the SOFA software for any
** purpose, including commercial applications, free of charge and
** without payment of royalties, subject to the conditions and
** restrictions listed below.
**
** 3. You (the user) may copy and distribute SOFA source code to others,
** and use and adapt its code and algorithms in your own software,
** on a world-wide, royalty-free basis. That portion of your
** distribution that does not consist of intact and unchanged copies
** of SOFA source code files is a "derived work" that must comply
** with the following requirements:
**
** a) Your work shall be marked or carry a statement that it
** (i) uses routines and computations derived by you from
** software provided by SOFA under license to you; and
** (ii) does not itself constitute software provided by and/or
** endorsed by SOFA.
**
** b) The source code of your derived work must contain descriptions
** of how the derived work is based upon, contains and/or differs
** from the original SOFA software.
**
** c) The names of all routines in your derived work shall not
** include the prefix "iau" or "sofa" or trivial modifications
** thereof such as changes of case.
**
** d) The origin of the SOFA components of your derived work must
** not be misrepresented; you must not claim that you wrote the
** original software, nor file a patent application for SOFA
** software or algorithms embedded in the SOFA software.
**
** e) These requirements must be reproduced intact in any source
** distribution and shall apply to anyone to whom you have
** granted a further right to modify the source code of your
** derived work.
**
** Note that, as originally distributed, the SOFA software is
** intended to be a definitive implementation of the IAU standards,
** and consequently third-party modifications are discouraged. All
** variations, no matter how minor, must be explicitly marked as
** such, as explained above.
**
** 4. You shall not cause the SOFA software to be brought into
** disrepute, either by misuse, or use for inappropriate tasks, or
** by inappropriate modification.
**
** 5. The SOFA software is provided "as is" and SOFA makes no warranty
** as to its use or performance. SOFA does not and cannot warrant
** the performance or results which the user may obtain by using the
** SOFA software. SOFA makes no warranties, express or implied, as
** to non-infringement of third party rights, merchantability, or
** fitness for any particular purpose. In no event will SOFA be
** liable to the user for any consequential, incidental, or special
** damages, including any lost profits or lost savings, even if a
** SOFA representative has been advised of such damages, or for any
** claim by any third party.
**
** 6. The provision of any version of the SOFA software under the terms
** and conditions specified herein does not imply that future
** versions will also be made available under the same terms and
** conditions.
*
** In any published work or commercial product which uses the SOFA
** software directly, acknowledgement (see www.iausofa.org) is
** appreciated.
**
** Correspondence concerning SOFA software should be addressed as
** follows:
**
** By email: [email protected]
** By post: IAU SOFA Center
** HM Nautical Almanac Office
** UK Hydrographic Office
** Admiralty Way, Taunton
** Somerset, TA1 2DN
** United Kingdom
**
**--------------------------------------------------------------------*/
}
double iauSepp(double a[3], double b[3])
/*
** - - - - - - - -
** i a u S e p p
** - - - - - - - -
**
** Angular separation between two p-vectors.
**
** This function is part of the International Astronomical Union's
** SOFA (Standards Of Fundamental Astronomy) software collection.
**
** Status: vector/matrix support function.
**
** Given:
** a double[3] first p-vector (not necessarily unit length)
** b double[3] second p-vector (not necessarily unit length)
**
** Returned (function value):
** double angular separation (radians, always positive)
**
** Notes:
**
** 1) If either vector is null, a zero result is returned.
**
** 2) The angular separation is most simply formulated in terms of
** scalar product. However, this gives poor accuracy for angles
** near zero and pi. The present algorithm uses both cross product
** and dot product, to deliver full accuracy whatever the size of
** the angle.
**
** Called:
** iauPxp vector product of two p-vectors
** iauPm modulus of p-vector
** iauPdp scalar product of two p-vectors
**
** This revision: 2008 May 22
**
** SOFA release 2012-03-01
**
** Copyright (C) 2012 IAU SOFA Board. See notes at end.
*/
{
double axb[3], ss, cs, s;
/* Sine of angle between the vectors, multiplied by the two moduli. */
iauPxp(a, b, axb);
ss = iauPm(axb);
/* Cosine of the angle, multiplied by the two moduli. */
cs = iauPdp(a, b);
/* The angle. */
s = ((ss != 0.0) || (cs != 0.0)) ? atan2(ss, cs) : 0.0;
return s;
/*----------------------------------------------------------------------
**
** Copyright (C) 2012
** Standards Of Fundamental Astronomy Board
** of the International Astronomical Union.
**
** =====================
** SOFA Software License
** =====================
**
** NOTICE TO USER:
**
** BY USING THIS SOFTWARE YOU ACCEPT THE FOLLOWING SIX TERMS AND
** CONDITIONS WHICH APPLY TO ITS USE.
**
** 1. The Software is owned by the IAU SOFA Board ("SOFA").
**
** 2. Permission is granted to anyone to use the SOFA software for any
** purpose, including commercial applications, free of charge and
** without payment of royalties, subject to the conditions and
** restrictions listed below.
**
** 3. You (the user) may copy and distribute SOFA source code to others,
** and use and adapt its code and algorithms in your own software,
** on a world-wide, royalty-free basis. That portion of your
** distribution that does not consist of intact and unchanged copies
** of SOFA source code files is a "derived work" that must comply
** with the following requirements:
**
** a) Your work shall be marked or carry a statement that it
** (i) uses routines and computations derived by you from
** software provided by SOFA under license to you; and
** (ii) does not itself constitute software provided by and/or
** endorsed by SOFA.
**
** b) The source code of your derived work must contain descriptions
** of how the derived work is based upon, contains and/or differs
** from the original SOFA software.
**
** c) The names of all routines in your derived work shall not
** include the prefix "iau" or "sofa" or trivial modifications
** thereof such as changes of case.
**
** d) The origin of the SOFA components of your derived work must
** not be misrepresented; you must not claim that you wrote the
** original software, nor file a patent application for SOFA
** software or algorithms embedded in the SOFA software.
**
** e) These requirements must be reproduced intact in any source
** distribution and shall apply to anyone to whom you have
** granted a further right to modify the source code of your
** derived work.
**
** Note that, as originally distributed, the SOFA software is
** intended to be a definitive implementation of the IAU standards,
** and consequently third-party modifications are discouraged. All
** variations, no matter how minor, must be explicitly marked as
** such, as explained above.
**
** 4. You shall not cause the SOFA software to be brought into
** disrepute, either by misuse, or use for inappropriate tasks, or
** by inappropriate modification.
**
** 5. The SOFA software is provided "as is" and SOFA makes no warranty
** as to its use or performance. SOFA does not and cannot warrant
** the performance or results which the user may obtain by using the
** SOFA software. SOFA makes no warranties, express or implied, as
** to non-infringement of third party rights, merchantability, or
** fitness for any particular purpose. In no event will SOFA be
** liable to the user for any consequential, incidental, or special
** damages, including any lost profits or lost savings, even if a
** SOFA representative has been advised of such damages, or for any
** claim by any third party.
**
** 6. The provision of any version of the SOFA software under the terms
** and conditions specified herein does not imply that future
** versions will also be made available under the same terms and
** conditions.
*
** In any published work or commercial product which uses the SOFA
** software directly, acknowledgement (see www.iausofa.org) is
** appreciated.
**
** Correspondence concerning SOFA software should be addressed as
** follows:
**
** By email: [email protected]
** By post: IAU SOFA Center
** HM Nautical Almanac Office
** UK Hydrographic Office
** Admiralty Way, Taunton
** Somerset, TA1 2DN
** United Kingdom
**
**--------------------------------------------------------------------*/
}
void mexFunction(int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[]) {
double TT1,TT2,*xVec;
double deltaT=0;
double LOD=0;
size_t numRow,numVec;
double CIRS2TIRS[3][3];
double TIRS2CIRS[3][3];
double Omega[3];//The rotation vector in the TIRS
mxArray *retMat;
double *retData;
if(nrhs<3||nrhs>5){
mexErrMsgTxt("Wrong number of inputs");
}
if(nlhs>2) {
mexErrMsgTxt("Wrong number of outputs.");
}
checkRealDoubleArray(prhs[0]);
numRow = mxGetM(prhs[0]);
numVec = mxGetN(prhs[0]);
if(!(numRow==3||numRow==6)) {
mexErrMsgTxt("The input vector has a bad dimensionality.");
}
xVec=(double*)mxGetData(prhs[0]);
TT1=getDoubleFromMatlab(prhs[1]);
TT2=getDoubleFromMatlab(prhs[2]);
//If some values from the function getEOP will be needed
if(nrhs<=4||mxIsEmpty(prhs[3])||mxIsEmpty(prhs[4])) {
mxArray *retVals[5];
mxArray *JulUTCMATLAB[2];
double JulUTC[2];
int retVal;
//Get the time in UTC to look up the parameters by going to TAI and
//then UTC.
retVal=iauTttai(TT1, TT2, &JulUTC[0], &JulUTC[1]);
if(retVal!=0) {
mexErrMsgTxt("An error occurred computing TAI.");
}
retVal=iauTaiutc(JulUTC[0], JulUTC[1], &JulUTC[0], &JulUTC[1]);
switch(retVal){
case 1:
mexWarnMsgTxt("Dubious Date entered.");
break;
case -1:
mexErrMsgTxt("Unacceptable date entered");
break;
default:
break;
}
JulUTCMATLAB[0]=doubleMat2Matlab(&JulUTC[0],1,1);
JulUTCMATLAB[1]=doubleMat2Matlab(&JulUTC[1],1,1);
//Get the Earth orientation parameters for the given date.
mexCallMATLAB(5,retVals,2,JulUTCMATLAB,"getEOP");
mxDestroyArray(JulUTCMATLAB[0]);
mxDestroyArray(JulUTCMATLAB[1]);
//We do not need the polar motion coordinates.
mxDestroyArray(retVals[0]);
//We do not need the celestial pole offsets.
mxDestroyArray(retVals[1]);
//This is TT-UT1
deltaT=getDoubleFromMatlab(retVals[3]);
LOD=getDoubleFromMatlab(retVals[4]);
//Free the returned arrays.
mxDestroyArray(retVals[2]);
mxDestroyArray(retVals[3]);
mxDestroyArray(retVals[4]);
}
//If deltaT=TT-UT1 is given
if(nrhs>3&&!mxIsEmpty(prhs[3])) {
deltaT=getDoubleFromMatlab(prhs[3]);
}
//If LOD is given
if(nrhs>4&&!mxIsEmpty(prhs[4])) {
LOD=getDoubleFromMatlab(prhs[4]);
}
//Compute the rotation matrix for going from CIRS to TIRS as well as
//the instantaneous vector angular momentum due to the Earth's rotation
//in GCRS coordinates.
{
double UT11, UT12;
double era, omega;
//Obtain UT1 from terestrial time and deltaT.
iauTtut1(TT1, TT2, deltaT, &UT11, &UT12);
//Find the Earth rotation angle for the given UT1 time.
era = iauEra00(UT11, UT12);
//Construct the rotation matrix.
CIRS2TIRS[0][0]=1;
CIRS2TIRS[0][1]=0;
CIRS2TIRS[0][2]=0;
CIRS2TIRS[1][0]=0;
CIRS2TIRS[1][1]=1;
CIRS2TIRS[1][2]=0;
CIRS2TIRS[2][0]=0;
CIRS2TIRS[2][1]=0;
CIRS2TIRS[2][2]=1;
iauRz(era, CIRS2TIRS);
//To go from the TIRS to the GCRS, we need to use the inverse rotation
//matrix, which is just the transpose of the rotation matrix.
iauTr(CIRS2TIRS, TIRS2CIRS);
//Next, to be able to transform the velocity, the rotation of the Earth
//has to be taken into account.
//The angular velocity vector of the Earth in the TIRS in radians.
omega=getScalarMatlabClassConst("Constants","IERSMeanEarthRotationRate");
//Adjust for LOD
omega=omega*(1-LOD/86400.0);//86400.0 is the number of seconds in a TT
//day.
Omega[0]=0;
Omega[1]=0;
Omega[2]=omega;
}
//Allocate space for the return vectors.
retMat=mxCreateDoubleMatrix(numRow,numVec,mxREAL);
retData=(double*)mxGetData(retMat);
{
size_t curVec;
for(curVec=0;curVec<numVec;curVec++) {
//Multiply the position vector with the rotation matrix.
iauRxp(TIRS2CIRS, xVec+numRow*curVec, retData+numRow*curVec);
//If a velocity vector was given.
if(numRow>3) {
double *posTIRS=xVec+numRow*curVec;
double *velTIRS=xVec+numRow*curVec+3;//Velocity in GCRS
double *retDataVel=retData+numRow*curVec+3;
double rotVel[3];
//Evaluate the cross product for the angular velocity due
//to the Earth's rotation.
iauPxp(Omega, posTIRS, rotVel);
//Add the instantaneous velocity due to rotation.
iauPpp(velTIRS, rotVel, retDataVel);
//Rotate from TIRS to GCRS
iauRxp(TIRS2CIRS, retDataVel, retDataVel);
}
}
}
plhs[0]=retMat;
if(nlhs>1) {
double *elPtr;
size_t i,j;
plhs[1]=mxCreateDoubleMatrix(3,3,mxREAL);
elPtr=(double*)mxGetData(plhs[1]);
for (i=0;i<3;i++) {
for(j=0;j<3;j++) {
elPtr[i+3*j]=TIRS2CIRS[i][j];
}
}
}
}
double iauPap(double a[3], double b[3])
/*
** - - - - - - -
** i a u P a p
** - - - - - - -
**
** Position-angle from two p-vectors.
**
** This function is part of the International Astronomical Union's
** SOFA (Standards Of Fundamental Astronomy) software collection.
**
** Status: vector/matrix support function.
**
** Given:
** a double[3] direction of reference point
** b double[3] direction of point whose PA is required
**
** Returned (function value):
** double position angle of b with respect to a (radians)
**
** Notes:
**
** 1) The result is the position angle, in radians, of direction b with
** respect to direction a. It is in the range -pi to +pi. The
** sense is such that if b is a small distance "north" of a the
** position angle is approximately zero, and if b is a small
** distance "east" of a the position angle is approximately +pi/2.
**
** 2) The vectors a and b need not be of unit length.
**
** 3) Zero is returned if the two directions are the same or if either
** vector is null.
**
** 4) If vector a is at a pole, the result is ill-defined.
**
** Called:
** iauPn decompose p-vector into modulus and direction
** iauPm modulus of p-vector
** iauPxp vector product of two p-vectors
** iauPmp p-vector minus p-vector
** iauPdp scalar product of two p-vectors
**
** This revision: 2008 May 25
**
** SOFA release 2012-03-01
**
** Copyright (C) 2012 IAU SOFA Board. See notes at end.
*/
{
double am, au[3], bm, st, ct, xa, ya, za, eta[3], xi[3], a2b[3], pa;
/* Modulus and direction of the a vector. */
iauPn(a, &am, au);
/* Modulus of the b vector. */
bm = iauPm(b);
/* Deal with the case of a null vector. */
if ((am == 0.0) || (bm == 0.0)) {
st = 0.0;
ct = 1.0;
} else {
/* The "north" axis tangential from a (arbitrary length). */
xa = a[0];
ya = a[1];
za = a[2];
eta[0] = -xa * za;
eta[1] = -ya * za;
eta[2] = xa*xa + ya*ya;
/* The "east" axis tangential from a (same length). */
iauPxp(eta, au, xi);
/* The vector from a to b. */
iauPmp(b, a, a2b);
/* Resolve into components along the north and east axes. */
st = iauPdp(a2b, xi);
ct = iauPdp(a2b, eta);
/* Deal with degenerate cases. */
if ((st == 0.0) && (ct == 0.0)) ct = 1.0;
}
/* Position angle. */
pa = atan2(st, ct);
return pa;
/*----------------------------------------------------------------------
**
** Copyright (C) 2012
** Standards Of Fundamental Astronomy Board
** of the International Astronomical Union.
**
** =====================
** SOFA Software License
** =====================
**
** NOTICE TO USER:
**
** BY USING THIS SOFTWARE YOU ACCEPT THE FOLLOWING SIX TERMS AND
** CONDITIONS WHICH APPLY TO ITS USE.
**
** 1. The Software is owned by the IAU SOFA Board ("SOFA").
**
** 2. Permission is granted to anyone to use the SOFA software for any
** purpose, including commercial applications, free of charge and
** without payment of royalties, subject to the conditions and
** restrictions listed below.
**
** 3. You (the user) may copy and distribute SOFA source code to others,
** and use and adapt its code and algorithms in your own software,
** on a world-wide, royalty-free basis. That portion of your
** distribution that does not consist of intact and unchanged copies
** of SOFA source code files is a "derived work" that must comply
** with the following requirements:
**
** a) Your work shall be marked or carry a statement that it
** (i) uses routines and computations derived by you from
** software provided by SOFA under license to you; and
** (ii) does not itself constitute software provided by and/or
** endorsed by SOFA.
**
** b) The source code of your derived work must contain descriptions
** of how the derived work is based upon, contains and/or differs
** from the original SOFA software.
**
** c) The names of all routines in your derived work shall not
** include the prefix "iau" or "sofa" or trivial modifications
** thereof such as changes of case.
**
** d) The origin of the SOFA components of your derived work must
** not be misrepresented; you must not claim that you wrote the
** original software, nor file a patent application for SOFA
** software or algorithms embedded in the SOFA software.
**
** e) These requirements must be reproduced intact in any source
** distribution and shall apply to anyone to whom you have
** granted a further right to modify the source code of your
** derived work.
**
** Note that, as originally distributed, the SOFA software is
** intended to be a definitive implementation of the IAU standards,
** and consequently third-party modifications are discouraged. All
** variations, no matter how minor, must be explicitly marked as
** such, as explained above.
**
** 4. You shall not cause the SOFA software to be brought into
** disrepute, either by misuse, or use for inappropriate tasks, or
** by inappropriate modification.
**
** 5. The SOFA software is provided "as is" and SOFA makes no warranty
** as to its use or performance. SOFA does not and cannot warrant
** the performance or results which the user may obtain by using the
** SOFA software. SOFA makes no warranties, express or implied, as
** to non-infringement of third party rights, merchantability, or
** fitness for any particular purpose. In no event will SOFA be
** liable to the user for any consequential, incidental, or special
** damages, including any lost profits or lost savings, even if a
** SOFA representative has been advised of such damages, or for any
** claim by any third party.
**
** 6. The provision of any version of the SOFA software under the terms
** and conditions specified herein does not imply that future
** versions will also be made available under the same terms and
** conditions.
*
** In any published work or commercial product which uses the SOFA
** software directly, acknowledgement (see www.iausofa.org) is
** appreciated.
**
** Correspondence concerning SOFA software should be addressed as
** follows:
**
** By email: [email protected]
** By post: IAU SOFA Center
** HM Nautical Almanac Office
** UK Hydrographic Office
** Admiralty Way, Taunton
** Somerset, TA1 2DN
** United Kingdom
**
**--------------------------------------------------------------------*/
}
void iauFk52h(double r5, double d5,
double dr5, double dd5, double px5, double rv5,
double *rh, double *dh,
double *drh, double *ddh, double *pxh, double *rvh)
/*
** - - - - - - - - -
** i a u F k 5 2 h
** - - - - - - - - -
**
** Transform FK5 (J2000.0) star data into the Hipparcos system.
**
** This function is part of the International Astronomical Union's
** SOFA (Standards Of Fundamental Astronomy) software collection.
**
** Status: support function.
**
** Given (all FK5, equinox J2000.0, epoch J2000.0):
** r5 double RA (radians)
** d5 double Dec (radians)
** dr5 double proper motion in RA (dRA/dt, rad/Jyear)
** dd5 double proper motion in Dec (dDec/dt, rad/Jyear)
** px5 double parallax (arcsec)
** rv5 double radial velocity (km/s, positive = receding)
**
** Returned (all Hipparcos, epoch J2000.0):
** rh double RA (radians)
** dh double Dec (radians)
** drh double proper motion in RA (dRA/dt, rad/Jyear)
** ddh double proper motion in Dec (dDec/dt, rad/Jyear)
** pxh double parallax (arcsec)
** rvh double radial velocity (km/s, positive = receding)
**
** Notes:
**
** 1) This function transforms FK5 star positions and proper motions
** into the system of the Hipparcos catalog.
**
** 2) The proper motions in RA are dRA/dt rather than
** cos(Dec)*dRA/dt, and are per year rather than per century.
**
** 3) The FK5 to Hipparcos transformation is modeled as a pure
** rotation and spin; zonal errors in the FK5 catalog are not
** taken into account.
**
** 4) See also iauH2fk5, iauFk5hz, iauHfk5z.
**
** Called:
** iauStarpv star catalog data to space motion pv-vector
** iauFk5hip FK5 to Hipparcos rotation and spin
** iauRxp product of r-matrix and p-vector
** iauPxp vector product of two p-vectors
** iauPpp p-vector plus p-vector
** iauPvstar space motion pv-vector to star catalog data
**
** Reference:
**
** F.Mignard & M.Froeschle, Astron. Astrophys. 354, 732-739 (2000).
**
** This revision: 2013 June 18
**
** SOFA release 2015-02-09
**
** Copyright (C) 2015 IAU SOFA Board. See notes at end.
*/
{
int i;
double pv5[2][3], r5h[3][3], s5h[3], wxp[3], vv[3], pvh[2][3];
/* FK5 barycentric position/velocity pv-vector (normalized). */
iauStarpv(r5, d5, dr5, dd5, px5, rv5, pv5);
/* FK5 to Hipparcos orientation matrix and spin vector. */
iauFk5hip(r5h, s5h);
/* Make spin units per day instead of per year. */
for ( i = 0; i < 3; s5h[i++] /= 365.25 );
/* Orient the FK5 position into the Hipparcos system. */
iauRxp(r5h, pv5[0], pvh[0]);
/* Apply spin to the position giving an extra space motion component. */
iauPxp(pv5[0], s5h, wxp);
/* Add this component to the FK5 space motion. */
iauPpp(wxp, pv5[1], vv);
/* Orient the FK5 space motion into the Hipparcos system. */
iauRxp(r5h, vv, pvh[1]);
/* Hipparcos pv-vector to spherical. */
iauPvstar(pvh, rh, dh, drh, ddh, pxh, rvh);
return;
/*----------------------------------------------------------------------
**
** Copyright (C) 2015
** Standards Of Fundamental Astronomy Board
** of the International Astronomical Union.
**
** =====================
** SOFA Software License
** =====================
**
** NOTICE TO USER:
**
** BY USING THIS SOFTWARE YOU ACCEPT THE FOLLOWING SIX TERMS AND
** CONDITIONS WHICH APPLY TO ITS USE.
**
** 1. The Software is owned by the IAU SOFA Board ("SOFA").
**
** 2. Permission is granted to anyone to use the SOFA software for any
** purpose, including commercial applications, free of charge and
** without payment of royalties, subject to the conditions and
** restrictions listed below.
**
** 3. You (the user) may copy and distribute SOFA source code to others,
** and use and adapt its code and algorithms in your own software,
** on a world-wide, royalty-free basis. That portion of your
** distribution that does not consist of intact and unchanged copies
** of SOFA source code files is a "derived work" that must comply
** with the following requirements:
**
** a) Your work shall be marked or carry a statement that it
** (i) uses routines and computations derived by you from
** software provided by SOFA under license to you; and
** (ii) does not itself constitute software provided by and/or
** endorsed by SOFA.
**
** b) The source code of your derived work must contain descriptions
** of how the derived work is based upon, contains and/or differs
** from the original SOFA software.
**
** c) The names of all routines in your derived work shall not
** include the prefix "iau" or "sofa" or trivial modifications
** thereof such as changes of case.
**
** d) The origin of the SOFA components of your derived work must
** not be misrepresented; you must not claim that you wrote the
** original software, nor file a patent application for SOFA
** software or algorithms embedded in the SOFA software.
**
** e) These requirements must be reproduced intact in any source
** distribution and shall apply to anyone to whom you have
** granted a further right to modify the source code of your
** derived work.
**
** Note that, as originally distributed, the SOFA software is
** intended to be a definitive implementation of the IAU standards,
** and consequently third-party modifications are discouraged. All
** variations, no matter how minor, must be explicitly marked as
** such, as explained above.
**
** 4. You shall not cause the SOFA software to be brought into
** disrepute, either by misuse, or use for inappropriate tasks, or
** by inappropriate modification.
**
** 5. The SOFA software is provided "as is" and SOFA makes no warranty
** as to its use or performance. SOFA does not and cannot warrant
** the performance or results which the user may obtain by using the
** SOFA software. SOFA makes no warranties, express or implied, as
** to non-infringement of third party rights, merchantability, or
** fitness for any particular purpose. In no event will SOFA be
** liable to the user for any consequential, incidental, or special
** damages, including any lost profits or lost savings, even if a
** SOFA representative has been advised of such damages, or for any
** claim by any third party.
**
** 6. The provision of any version of the SOFA software under the terms
** and conditions specified herein does not imply that future
** versions will also be made available under the same terms and
** conditions.
*
** In any published work or commercial product which uses the SOFA
** software directly, acknowledgement (see www.iausofa.org) is
** appreciated.
**
** Correspondence concerning SOFA software should be addressed as
** follows:
**
** By email: [email protected]
** By post: IAU SOFA Center
** HM Nautical Almanac Office
** UK Hydrographic Office
** Admiralty Way, Taunton
** Somerset, TA1 2DN
** United Kingdom
**
**--------------------------------------------------------------------*/
}
void mexFunction(int nlhs, mxArray *plhs[], int nrhs, const mxArray *prhs[]) {
size_t numRow,numVec;
mxArray *retMat;
double *xVec, *retData;
double TT1, TT2, UT11, UT12;
//The if-statements below should properly initialize all of the EOP.
//The following initializations to zero are to suppress warnings when
//compiling with -Wconditional-uninitialized.
double xp=0;
double yp=0;
double deltaT=0;
double LOD=0;
double ITRS2TEME[3][3];
double PEF2TEME[3][3];
double WInv[3][3];//The inverse polar motion matrix to go from ITRS to PEF.
double Omega[3];//The angular velocity vector for the Earth's rotation.
if(nrhs<3||nrhs>6){
mexErrMsgTxt("Wrong number of inputs");
}
if(nlhs>2) {
mexErrMsgTxt("Wrong number of outputs.");
return;
}
checkRealDoubleArray(prhs[0]);
numRow = mxGetM(prhs[0]);
numVec = mxGetN(prhs[0]);
if(!(numRow==3||numRow==6)) {
mexErrMsgTxt("The input vector has a bad dimensionality.");
}
xVec=(double*)mxGetData(prhs[0]);
TT1=getDoubleFromMatlab(prhs[1]);
TT2=getDoubleFromMatlab(prhs[2]);
//If some values from the function getEOP will be needed
if(nrhs<6||mxIsEmpty(prhs[3])||mxIsEmpty(prhs[4])||mxIsEmpty(prhs[5])) {
mxArray *retVals[5];
double *xpyp;
mxArray *JulUTCMATLAB[2];
double JulUTC[2];
int retVal;
//Get the time in UTC to look up the parameters by going to TAI and
//then UTC.
retVal=iauTttai(TT1, TT2, &JulUTC[0], &JulUTC[1]);
if(retVal!=0) {
mexErrMsgTxt("An error occurred computing TAI.");
}
retVal=iauTaiutc(JulUTC[0], JulUTC[1], &JulUTC[0], &JulUTC[1]);
switch(retVal){
case 1:
mexWarnMsgTxt("Dubious Date entered.");
break;
case -1:
mexErrMsgTxt("Unacceptable date entered");
break;
default:
break;
}
JulUTCMATLAB[0]=doubleMat2Matlab(&JulUTC[0],1,1);
JulUTCMATLAB[1]=doubleMat2Matlab(&JulUTC[1],1,1);
//Get the Earth orientation parameters for the given date.
mexCallMATLAB(5,retVals,2,JulUTCMATLAB,"getEOP");
mxDestroyArray(JulUTCMATLAB[0]);
mxDestroyArray(JulUTCMATLAB[1]);
checkRealDoubleArray(retVals[0]);
checkRealDoubleArray(retVals[1]);
if(mxGetM(retVals[0])!=2||mxGetN(retVals[0])!=1||mxGetM(retVals[1])!=2||mxGetN(retVals[1])!=1) {
mxDestroyArray(retVals[0]);
mxDestroyArray(retVals[1]);
mxDestroyArray(retVals[2]);
mxDestroyArray(retVals[3]);
mxDestroyArray(retVals[4]);
mexErrMsgTxt("Error using the getEOP function.");
return;
}
xpyp=(double*)mxGetData(retVals[0]);
xp=xpyp[0];
yp=xpyp[1];
//The celestial pole offsets are not used.
//This is TT-UT1
deltaT=getDoubleFromMatlab(retVals[3]);
LOD=getDoubleFromMatlab(retVals[4]);
//Free the returned arrays.
mxDestroyArray(retVals[0]);
mxDestroyArray(retVals[1]);
mxDestroyArray(retVals[2]);
mxDestroyArray(retVals[3]);
mxDestroyArray(retVals[4]);
}
//If deltaT=TT-UT1 is given
if(nrhs>3&&!mxIsEmpty(prhs[3])) {
deltaT=getDoubleFromMatlab(prhs[3]);
}
//Obtain UT1 from terestrial time and deltaT.
iauTtut1(TT1, TT2, deltaT, &UT11, &UT12);
//Get polar motion values, if given.
if(nrhs>4&&!mxIsEmpty(prhs[4])) {
size_t dim1, dim2;
checkRealDoubleArray(prhs[4]);
dim1 = mxGetM(prhs[4]);
dim2 = mxGetN(prhs[4]);
if((dim1==2&&dim2==1)||(dim1==1&&dim2==2)) {
double *xpyp=(double*)mxGetData(prhs[4]);
xp=xpyp[0];
yp=xpyp[1];
} else {
mexErrMsgTxt("The celestial pole offsets have the wrong dimensionality.");
return;
}
}
//If LOD is given
if(nrhs>5&&!mxIsEmpty(prhs[5])) {
LOD=getDoubleFromMatlab(prhs[5]);
}
{
double GMST1982=iauGmst82(UT11, UT12);
double TEME2PEF[3][3];
double TEME2ITRS[3][3];
double W[3][3];
double omega;
//Get Greenwhich mean sidereal time under the IAU's 1982 model. This
//is given in radians and will be used to build a rotation matrix to
//rotate into the PEF system.
GMST1982=iauGmst82(UT11, UT12);
{
double cosGMST,sinGMST;
cosGMST=cos(GMST1982);
sinGMST=sin(GMST1982);
//Build the rotation matrix to rotate by GMST about the z-axis. This
//will put the position vector in the PEF system.
TEME2PEF[0][0]=cosGMST;
TEME2PEF[0][1]=sinGMST;
TEME2PEF[0][2]=0;
TEME2PEF[1][0]=-sinGMST;
TEME2PEF[1][1]=cosGMST;
TEME2PEF[1][2]=0;
TEME2PEF[2][0]=0;
TEME2PEF[2][1]=0;
TEME2PEF[2][2]=1.0;
}
//The inverse rotation is just the transpose
iauTr(TEME2PEF, PEF2TEME);
//To go from PEF to ITRS, we need to build the polar motion matrix
//using the IAU's 1980 conventions.
{
double cosXp,sinXp,cosYp,sinYp;
cosXp=cos(xp);
sinXp=sin(xp);
cosYp=cos(yp);
sinYp=sin(yp);
W[0][0]=cosXp;
W[0][1]=sinXp*sinYp;
W[0][2]=sinXp*cosYp;
W[1][0]=0;
W[1][1]=cosYp;
W[1][2]=-sinYp;
W[2][0]=-sinXp;
W[2][1]=cosXp*sinXp;
W[2][2]=cosXp*cosYp;
}
//The inverse rotation is just the transpose
iauTr(W, WInv);
//The total rotation matrix is thus the product of the two rotations.
//TEME2ITRS=W*TEME2PEF;
iauRxr(W, TEME2PEF, TEME2ITRS);
//We want the inverse rotation
iauTr(TEME2ITRS, ITRS2TEME);
//The angular velocity vector of the Earth in the TIRS in radians.
omega=getScalarMatlabClassConst("Constants","IERSMeanEarthRotationRate");
//Adjust for LOD
omega=omega*(1-LOD/86400.0);//86400.0 is the number of seconds in a TT day.
Omega[0]=0;
Omega[1]=0;
Omega[2]=omega;
}
//Allocate space for the return vectors.
retMat=mxCreateDoubleMatrix(numRow,numVec,mxREAL);
retData=(double*)mxGetData(retMat);
{
size_t curVec;
for(curVec=0;curVec<numVec;curVec++) {
//Multiply the position vector with the rotation matrix.
iauRxp(ITRS2TEME, xVec+numRow*curVec, retData+numRow*curVec);
//If a velocity vector was given.
if(numRow>3) {
double *posITRS=xVec+numRow*curVec;
double *velITRS=xVec+numRow*curVec+3;//Velocity in TEME
double posPEF[3];
double velPEF[3];
double *retDataVel=retData+numRow*curVec+3;
double rotVel[3];
//If a velocity was provided with the position, first
//convert to PEF coordinates, then account for the rotation
//of the Earth, then rotate into TEME coordinates.
//Convert velocity from ITRS to PEF.
iauRxp(WInv, velITRS, velPEF);
//Convert position from ITRS to PEF
iauRxp(WInv, posITRS, posPEF);
//Evaluate the cross product for the angular velocity due
//to the Earth's rotation.
iauPxp(Omega, posPEF, rotVel);
//Add the instantaneous velocity due to rotation.
iauPpp(velPEF, rotVel, retDataVel);
//Rotate from the PEF into the TEME
iauRxp(PEF2TEME, retDataVel, retDataVel);
}
}
}
plhs[0]=retMat;
if(nlhs>1) {
double *elPtr;
size_t i,j;
plhs[1]=mxCreateDoubleMatrix(3,3,mxREAL);
elPtr=(double*)mxGetData(plhs[1]);
for (i=0;i<3;i++) {
for(j=0;j<3;j++) {
elPtr[i+3*j]=ITRS2TEME[i][j];
}
}
}
}