00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039 #include "RMC01.h"
00040
00041
00042 double g_0( double theta, double e )
00043 {
00044 double g = 0.0;
00045
00046 double ct = cos(theta);
00047 double e_ = e;
00048
00049 double temp3 = 2.0 * e_ - 1.0;
00050 double temp4 = 4.0 * ( 1.0 - e_ * e_ ) * ct * ct;
00051
00052 double upper = temp4 + temp3 * temp3;
00053 double lower =
00054 2.0 * ( 1.0 - e_ *e_ ) * ct +
00055 temp3 *sqrt ( temp4 + 5.0 * e_ * e_ - 4. * e_ );
00056
00057 g = upper/lower;
00058 return g;
00059 }
00060
00061
00062 double g_prime( double theta, double e )
00063 {
00064 double g_prime = 0.0;
00065
00066 double ct = cos(theta);
00067 double st = sin(theta);
00068 double e_ = e;
00069
00070 double temp2 = 1.0 - e_ * e_;
00071 double temp3 = 2.0 * e_ - 1.0;
00072 double temp4 = 4.0 * temp2 * ct * ct;
00073
00074 double N = temp4 + temp3*temp3;
00075
00076 double tempsqrt = temp4 + 5.0*e_*e_ - 4.0 * e_ ;
00077
00078
00079
00080
00081
00082
00083
00084
00085
00086
00087
00088
00089
00090
00091
00092
00093 double temp1 = sqrt( tempsqrt );
00094 double D = 2.0*temp2*ct + temp3*temp1;
00095
00096 double N_prime = -8.0*temp2*ct*st;
00097
00098 double temp5 = 2.0*temp2*st;
00099 double temp6 = 4.0*temp3*temp2*ct*st;
00100 double D_prime = - temp5 - temp6/temp1;
00101
00102 g_prime = - N*D_prime/(D*D) + N_prime/D;
00103
00104 return g_prime;
00105 }
00106
00107
00108 double g_second( double theta, double e )
00109 {
00110 double g_second = 0.0;
00111
00112 double ct = cos(theta);
00113 double st = sin(theta);
00114 double e_ = e;
00115
00116
00117 double temp2 = 1.0-e_*e_;
00118 double temp3 = 2.0*e_-1.0;
00119 double temp4 = 4.0*temp2*ct*ct;
00120
00121 double N = temp4 + temp3*temp3;
00122
00123 double tempsqrt = temp4+5.0*e_*e_-4.0*e_ ;
00124
00125
00126
00127
00128
00129
00130
00131
00132
00133
00134
00135
00136
00137
00138
00139 double temp1 = sqrt(tempsqrt);
00140 double D = 2.0*temp2*ct + temp3*temp1;
00141
00142 double N_prime = -8.0*temp2*ct*st;
00143
00144 double temp5 = 2.0*temp2*st;
00145 double temp6 = 4.0*temp3*temp2*ct*st;
00146 double D_prime = - temp5 - temp6/temp1;
00147
00148 double N_second = - 8.0*temp2*ct*ct + 8.0*temp2*st*st;
00149
00150 double temp7 = 4.0*temp3*temp2*ct*ct;
00151 double temp8 = 16.0*temp3*temp2*temp2*ct*ct*st*st;
00152 double temp9 = 4.0*temp3*temp2*st*st;
00153 double temp10 = 2.0*temp2*ct;
00154 double D_second = - temp10 -
00155 temp7/temp1 -
00156 temp8/(temp1*temp1*temp1) +
00157 temp9/temp1;
00158
00159 g_second = 2.0 * N * D_prime * D_prime / (D*D*D) -
00160 2.0 * D_prime * N_prime / (D*D) -
00161 N * D_second / (D*D) +
00162 N_second / D;
00163
00164 return g_second;
00165 }