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 xp=0;
double yp=0;
double deltaT=0;
double LOD=0;
double ITRS2GCRS[3][3];
double TIRS2GCRS[3][3];
double invrPom[3][3];//Inverse polar motion matrix. TIRS=IPOM*ITRS.
double Omega[3];
if(nrhs<3||nrhs>7){
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])||mxIsEmpty(prhs[6])) {
mxArray *retVals[5];
double *xpyp, *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]);
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]);
dXdY=(double*)mxGetData(retVals[1]);
xp=xpyp[0];
yp=xpyp[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[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);
//If no values for the polar motion coordinates are given, then use
//zeros.
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(nrhs>5&&!mxIsEmpty(prhs[5])) {
size_t dim1, dim2;
checkRealDoubleArray(prhs[5]);
dim1 = mxGetM(prhs[5]);
dim2 = mxGetN(prhs[5]);
if((dim1==2&&dim2==1)||(dim1==1&&dim2==2)) {
double *dXdY=(double*)mxGetData(prhs[5]);
dX=dXdY[0];
dY=dXdY[1];
} else {
mexErrMsgTxt("The polar motion coordinates have the wrong dimensionality.");
return;
}
}
//If LOD is given
if(nrhs>6&&!mxIsEmpty(prhs[6])) {
LOD=getDoubleFromMatlab(prhs[6]);
}
//Compute the rotation matrix for going from ITRS to GCRS as well as
//the instantaneous vector angular momentum due to the Earth's rotation
//in TIRS coordinates.
{
double x, y, s, era, sp;
double rpom[3][3], rc2i[3][3];
double GCRS2ITRS[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);
//Get the Terrestrial Intermediate Origin (TIO) locator s' in radians
sp=iauSp00(TT1,TT2);
//Get the polar motion matrix
iauPom00(xp,yp,sp,rpom);
//Combine the GCRS-to-CIRS matrix, the Earth rotation angle, and the
//polar motion matrix to get a transformation matrix to get the
//rotation matrix to go from GCRS to ITRS.
iauC2tcio(rc2i, era, rpom,GCRS2ITRS);
//To go from the ITRS to the GCRS, we need to use the inverse rotation
//matrix, which is just the transpose of the rotation matrix.
iauTr(GCRS2ITRS, ITRS2GCRS);
//Next, to be able to transform the velocity, the rotation of the Earth
//has to be taken into account. This requires first transforming from
//ITRS to TIRS coordinates, where the rotational axis is the z-axis.
//That transformation requires the inverse polar motion matrix, which,
//being a rotation matrix, is given by its transpose.
iauTr(rpom, invrPom);
//Then, one must transform from TIRS to GCRS, which can be done by
//taking the inverse of the rotation matrix from GCRS to ITRS computed
//using the identity matrix for polar motion (i.e. no polar motion
//means leaving it in the TIRS.
{
double rident[3][3]={{1,0,0},{0,1,0},{0,0,1}};
double GCRS2TIRS[3][3];
iauC2tcio(rc2i, era, rident,GCRS2TIRS);
iauTr(GCRS2TIRS, TIRS2GCRS);
}
//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(ITRS2GCRS, xVec+numRow*curVec, retData+numRow*curVec);
//If a velocity vector was given.
if(numRow>3) {
double posTIRS[3];
double velTIRS[3];
double *posITRS=xVec+numRow*curVec;
double *velITRS=xVec+numRow*curVec+3;//Velocity in GCRS
double *retDataVel=retData+numRow*curVec+3;
double rotVel[3];
//If a velocity was provided with the position, then first
//convert into the TIRS, then account for the rotation of
//the Earth, then rotate into the GCRS.
//Convert velocity from ITRS to TIRS.
iauRxp(invrPom, velITRS, velTIRS);
//Convert position from ITRS to TIRS
iauRxp(invrPom, posITRS, posTIRS);
//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(TIRS2GCRS, 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]=ITRS2GCRS[i][j];
}
}
}
}
int iauPvstar(double pv[2][3], double *ra, double *dec,
double *pmr, double *pmd, double *px, double *rv)
/*
** - - - - - - - - - -
** i a u P v s t a r
** - - - - - - - - - -
**
** Convert star position+velocity vector to catalog coordinates.
**
** This function is part of the International Astronomical Union's
** SOFA (Standards Of Fundamental Astronomy) software collection.
**
** Status: support function.
**
** Given (Note 1):
** pv double[2][3] pv-vector (AU, AU/day)
**
** Returned (Note 2):
** ra double right ascension (radians)
** dec double declination (radians)
** pmr double RA proper motion (radians/year)
** pmd double Dec proper motion (radians/year)
** px double parallax (arcsec)
** rv double radial velocity (km/s, positive = receding)
**
** Returned (function value):
** int status:
** 0 = OK
** -1 = superluminal speed (Note 5)
** -2 = null position vector
**
** Notes:
**
** 1) The specified pv-vector is the coordinate direction (and its rate
** of change) for the date at which the light leaving the star
** reached the solar-system barycenter.
**
** 2) The star data returned by this function are "observables" for an
** imaginary observer at the solar-system barycenter. Proper motion
** and radial velocity are, strictly, in terms of barycentric
** coordinate time, TCB. For most practical applications, it is
** permissible to neglect the distinction between TCB and ordinary
** "proper" time on Earth (TT/TAI). The result will, as a rule, be
** limited by the intrinsic accuracy of the proper-motion and
** radial-velocity data; moreover, the supplied pv-vector is likely
** to be merely an intermediate result (for example generated by the
** function iauStarpv), so that a change of time unit will cancel
** out overall.
**
** In accordance with normal star-catalog conventions, the object's
** right ascension and declination are freed from the effects of
** secular aberration. The frame, which is aligned to the catalog
** equator and equinox, is Lorentzian and centered on the SSB.
**
** Summarizing, the specified pv-vector is for most stars almost
** identical to the result of applying the standard geometrical
** "space motion" transformation to the catalog data. The
** differences, which are the subject of the Stumpff paper cited
** below, are:
**
** (i) In stars with significant radial velocity and proper motion,
** the constantly changing light-time distorts the apparent proper
** motion. Note that this is a classical, not a relativistic,
** effect.
**
** (ii) The transformation complies with special relativity.
**
** 3) Care is needed with units. The star coordinates are in radians
** and the proper motions in radians per Julian year, but the
** parallax is in arcseconds; the radial velocity is in km/s, but
** the pv-vector result is in AU and AU/day.
**
** 4) The proper motions are the rate of change of the right ascension
** and declination at the catalog epoch and are in radians per Julian
** year. The RA proper motion is in terms of coordinate angle, not
** true angle, and will thus be numerically larger at high
** declinations.
**
** 5) Straight-line motion at constant speed in the inertial frame is
** assumed. If the speed is greater than or equal to the speed of
** light, the function aborts with an error status.
**
** 6) The inverse transformation is performed by the function iauStarpv.
**
** Called:
** iauPn decompose p-vector into modulus and direction
** iauPdp scalar product of two p-vectors
** iauSxp multiply p-vector by scalar
** iauPmp p-vector minus p-vector
** iauPm modulus of p-vector
** iauPpp p-vector plus p-vector
** iauPv2s pv-vector to spherical
** iauAnp normalize angle into range 0 to 2pi
**
** Reference:
**
** Stumpff, P., 1985, Astron.Astrophys. 144, 232-240.
**
** This revision: 2013 June 18
**
** SOFA release 2015-02-09
**
** Copyright (C) 2015 IAU SOFA Board. See notes at end.
*/
{
double r, x[3], vr, ur[3], vt, ut[3], bett, betr, d, w, del,
usr[3], ust[3], a, rad, decd, rd;
/* Isolate the radial component of the velocity (AU/day, inertial). */
iauPn(pv[0], &r, x);
vr = iauPdp(x, pv[1]);
iauSxp(vr, x, ur);
/* Isolate the transverse component of the velocity (AU/day, inertial). */
iauPmp(pv[1], ur, ut);
vt = iauPm(ut);
/* Special-relativity dimensionless parameters. */
bett = vt / DC;
betr = vr / DC;
/* The inertial-to-observed correction terms. */
d = 1.0 + betr;
w = 1.0 - betr*betr - bett*bett;
if (d == 0.0 || w < 0) return -1;
del = sqrt(w) - 1.0;
/* Apply relativistic correction factor to radial velocity component. */
w = (betr != 0) ? (betr - del) / (betr * d) : 1.0;
iauSxp(w, ur, usr);
/* Apply relativistic correction factor to tangential velocity */
/* component. */
iauSxp(1.0/d, ut, ust);
/* Combine the two to obtain the observed velocity vector (AU/day). */
iauPpp(usr, ust, pv[1]);
/* Cartesian to spherical. */
iauPv2s(pv, &a, dec, &r, &rad, &decd, &rd);
if (r == 0.0) return -2;
/* Return RA in range 0 to 2pi. */
*ra = iauAnp(a);
/* Return proper motions in radians per year. */
*pmr = rad * DJY;
*pmd = decd * DJY;
/* Return parallax in arcsec. */
*px = DR2AS / r;
/* Return radial velocity in km/s. */
*rv = 1e-3 * rd * DAU / DAYSEC;
/* OK status. */
return 0;
/*----------------------------------------------------------------------
**
** 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
**
**--------------------------------------------------------------------*/
}
int iauStarpv(double ra, double dec,
double pmr, double pmd, double px, double rv,
double pv[2][3])
/*
** - - - - - - - - - -
** i a u S t a r p v
** - - - - - - - - - -
**
** Convert star catalog coordinates to position+velocity vector.
**
** Status: support function.
**
** Given (Note 1):
** ra double right ascension (radians)
** dec double declination (radians)
** pmr double RA proper motion (radians/year)
** pmd double Dec proper motion (radians/year)
** px double parallax (arcseconds)
** rv double radial velocity (km/s, positive = receding)
**
** Returned (Note 2):
** pv double[2][3] pv-vector (AU, AU/day)
**
** Returned (function value):
** int status:
** 0 = no warnings
** 1 = distance overridden (Note 6)
** 2 = excessive speed (Note 7)
** 4 = solution didn't converge (Note 8)
** else = binary logical OR of the above
**
** Notes:
**
** 1) The star data accepted by this function are "observables" for an
** imaginary observer at the solar-system barycenter. Proper motion
** and radial velocity are, strictly, in terms of barycentric
** coordinate time, TCB. For most practical applications, it is
** permissible to neglect the distinction between TCB and ordinary
** "proper" time on Earth (TT/TAI). The result will, as a rule, be
** limited by the intrinsic accuracy of the proper-motion and
** radial-velocity data; moreover, the pv-vector is likely to be
** merely an intermediate result, so that a change of time unit
** would cancel out overall.
**
** In accordance with normal star-catalog conventions, the object's
** right ascension and declination are freed from the effects of
** secular aberration. The frame, which is aligned to the catalog
** equator and equinox, is Lorentzian and centered on the SSB.
**
** 2) The resulting position and velocity pv-vector is with respect to
** the same frame and, like the catalog coordinates, is freed from
** the effects of secular aberration. Should the "coordinate
** direction", where the object was located at the catalog epoch, be
** required, it may be obtained by calculating the magnitude of the
** position vector pv[0][0-2] dividing by the speed of light in
** AU/day to give the light-time, and then multiplying the space
** velocity pv[1][0-2] by this light-time and adding the result to
** pv[0][0-2].
**
** Summarizing, the pv-vector returned is for most stars almost
** identical to the result of applying the standard geometrical
** "space motion" transformation. The differences, which are the
** subject of the Stumpff paper referenced below, are:
**
** (i) In stars with significant radial velocity and proper motion,
** the constantly changing light-time distorts the apparent proper
** motion. Note that this is a classical, not a relativistic,
** effect.
**
** (ii) The transformation complies with special relativity.
**
** 3) Care is needed with units. The star coordinates are in radians
** and the proper motions in radians per Julian year, but the
** parallax is in arcseconds; the radial velocity is in km/s, but
** the pv-vector result is in AU and AU/day.
**
** 4) The RA proper motion is in terms of coordinate angle, not true
** angle. If the catalog uses arcseconds for both RA and Dec proper
** motions, the RA proper motion will need to be divided by cos(Dec)
** before use.
**
** 5) Straight-line motion at constant speed, in the inertial frame,
** is assumed.
**
** 6) An extremely small (or zero or negative) parallax is interpreted
** to mean that the object is on the "celestial sphere", the radius
** of which is an arbitrary (large) value (see the constant PXMIN).
** When the distance is overridden in this way, the status,
** initially zero, has 1 added to it.
**
** 7) If the space velocity is a significant fraction of c (see the
** constant VMAX), it is arbitrarily set to zero. When this action
** occurs, 2 is added to the status.
**
** 8) The relativistic adjustment involves an iterative calculation.
** If the process fails to converge within a set number (IMAX) of
** iterations, 4 is added to the status.
**
** 9) The inverse transformation is performed by the function
** iauPvstar.
**
** Called:
** iauS2pv spherical coordinates to pv-vector
** iauPm modulus of p-vector
** iauZp zero p-vector
** iauPn decompose p-vector into modulus and direction
** iauPdp scalar product of two p-vectors
** iauSxp multiply p-vector by scalar
** iauPmp p-vector minus p-vector
** iauPpp p-vector plus p-vector
**
** Reference:
**
** Stumpff, P., 1985, Astron.Astrophys. 144, 232-240.
**
** This revision: 2009 July 6
**
** Original version 2012-03-01
**
** Copyright (C) 2013 Naoki Arita. See notes at end.
*/
{
/* Smallest allowed parallax */
static const double PXMIN = 1e-7;
/* Largest allowed speed (fraction of c) */
static const double VMAX = 0.5;
/* Maximum number of iterations for relativistic solution */
static const int IMAX = 100;
int i, iwarn;
double w, r, rd, rad, decd, v, x[3], usr[3], ust[3],
vsr, vst, betst, betsr, bett, betr,
dd, ddel, ur[3], ut[3],
d = 0.0, del = 0.0, /* to prevent */
odd = 0.0, oddel = 0.0, /* compiler */
od = 0.0, odel = 0.0; /* warnings */
/* Distance (AU). */
if (px >= PXMIN) {
w = px;
iwarn = 0;
} else {
w = PXMIN;
iwarn = 1;
}
r = DR2AS / w;
/* Radial velocity (AU/day). */
rd = DAYSEC * rv * 1e3 / DAU;
/* Proper motion (radian/day). */
rad = pmr / DJY;
decd = pmd / DJY;
/* To pv-vector (AU,AU/day). */
iauS2pv(ra, dec, r, rad, decd, rd, pv);
/* If excessive velocity, arbitrarily set it to zero. */
v = iauPm(pv[1]);
if (v / DC > VMAX) {
iauZp(pv[1]);
iwarn += 2;
}
/* Isolate the radial component of the velocity (AU/day). */
iauPn(pv[0], &w, x);
vsr = iauPdp(x, pv[1]);
iauSxp(vsr, x, usr);
/* Isolate the transverse component of the velocity (AU/day). */
iauPmp(pv[1], usr, ust);
vst = iauPm(ust);
/* Special-relativity dimensionless parameters. */
betsr = vsr / DC;
betst = vst / DC;
/* Determine the inertial-to-observed relativistic correction terms. */
bett = betst;
betr = betsr;
for (i = 0; i < IMAX; i++) {
d = 1.0 + betr;
del = sqrt(1.0 - betr*betr - bett*bett) - 1.0;
betr = d * betsr + del;
bett = d * betst;
if (i > 0) {
dd = fabs(d - od);
ddel = fabs(del - odel);
if ((i > 1) && (dd >= odd) && (ddel >= oddel)) break;
odd = dd;
oddel = ddel;
}
od = d;
odel = del;
}
if (i >= IMAX) iwarn += 4;
/* Replace observed radial velocity with inertial value. */
w = (betsr != 0.0) ? d + del / betsr : 1.0;
iauSxp(w, usr, ur);
/* Replace observed tangential velocity with inertial value. */
iauSxp(d, ust, ut);
/* Combine the two to obtain the inertial space velocity. */
iauPpp(ur, ut, pv[1]);
/* Return the status. */
return iwarn;
/*----------------------------------------------------------------------
**
** Celes is a wrapper of the SOFA Library for Ruby.
**
** This file is redistributed and relicensed in accordance with
** the SOFA Software License (http://www.iausofa.org/tandc.html).
**
** The original library is available from IAU Standards of
** Fundamental Astronomy (http://www.iausofa.org/).
**
**
**
**
**
** Copyright (C) 2013, Naoki Arita
** All rights reserved.
**
** Redistribution and use in source and binary forms, with or without
** modification, are permitted provided that the following conditions
** are met:
**
** 1 Redistributions of source code must retain the above copyright
** notice, this list of conditions and the following disclaimer.
**
** 2 Redistributions in binary form must reproduce the above copyright
** notice, this list of conditions and the following disclaimer in
** the documentation and/or other materials provided with the
** distribution.
**
** 3 Neither the name of the Standards Of Fundamental Astronomy Board,
** the International Astronomical Union nor the names of its
** contributors may be used to endorse or promote products derived
** from this software without specific prior written permission.
**
** THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
** "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
** LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
** FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
** COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
** INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
** BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
** LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
** CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
** LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
** ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
** POSSIBILITY OF SUCH DAMAGE.
**
**--------------------------------------------------------------------*/
}
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];
}
}
}
}
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 iauPvppv(double a[2][3], double b[2][3], double apb[2][3])
/*
** - - - - - - - - -
** i a u P v p p v
** - - - - - - - - -
**
** Add one pv-vector to another.
**
** 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[2][3] first pv-vector
** b double[2][3] second pv-vector
**
** Returned:
** apb double[2][3] a + b
**
** Note:
** It is permissible to re-use the same array for any of the
** arguments.
**
** Called:
** iauPpp p-vector plus p-vector
**
** This revision: 2013 June 18
**
** SOFA release 2013-12-02
**
** Copyright (C) 2013 IAU SOFA Board. See notes at end.
*/
{
iauPpp(a[0], b[0], apb[0]);
iauPpp(a[1], b[1], apb[1]);
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
**
**--------------------------------------------------------------------*/
}
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];
}
}
}
}
