Archived
673 lines
19 KiB
C
673 lines
19 KiB
C
#ifndef _READ_H_
|
||
#define _READ_H_
|
||
|
||
#include<stdio.h>
|
||
#include<string.h>
|
||
|
||
#define MAXRINEX 1000//一行最大字符数
|
||
/* ------------------------------ WGS-84 CONST ------------------------------ */
|
||
#define a 6378137.0
|
||
#define e2 (0.0033528106647475*(2 - 0.0033528106647475))
|
||
#define C_V 299792458
|
||
#define GM 398600500000000
|
||
#define math_e 2.718281828459
|
||
#define PI 3.141592653589793
|
||
#define Earth_e 7.2921151467e-5
|
||
#define C1 0
|
||
/* ----------------------------- GPS OBSERV TYPE ---------------------------- */
|
||
#define C1C 101
|
||
#define C1S 102
|
||
#define C1L 103
|
||
#define C1X 104
|
||
#define C1P 105
|
||
#define C1W 106
|
||
#define C1Y 107
|
||
#define C1M 108
|
||
|
||
#define C2C 201
|
||
#define C2S 202
|
||
#define C2L 203
|
||
#define C2X 204
|
||
#define C2P 205
|
||
#define C2W 206
|
||
#define C2Y 207
|
||
#define C2M 208
|
||
|
||
#define C5I 501
|
||
#define C5Q 502
|
||
#define C5X 503
|
||
/* ------------------------------ FOR CALMOD.H ------------------------------ */
|
||
//卫星位置结构体
|
||
typedef struct
|
||
{
|
||
double X[36];
|
||
double Y[36];
|
||
double Z[36];
|
||
double deltat[36];//改正前的信号传播时间
|
||
double delta_t[36];//改正后的信号传播时间
|
||
double delta_clk[36];
|
||
}pos_t, *ppos_t;
|
||
|
||
//测站位置结构体
|
||
typedef struct
|
||
{
|
||
double X;
|
||
double Y;
|
||
double Z;
|
||
double B;
|
||
double L;
|
||
double H;
|
||
double delta_TR;
|
||
}station, *pstation;
|
||
//经纬高结构体
|
||
typedef struct
|
||
{
|
||
double B;
|
||
int B_d;
|
||
int B_m;
|
||
int B_s;
|
||
double L;
|
||
int L_d;
|
||
int L_m;
|
||
int L_s;
|
||
double H;
|
||
}blh, *pblh;
|
||
//东北天结构体
|
||
typedef struct enu
|
||
{
|
||
double E;
|
||
double N;
|
||
double U;
|
||
}enu, *penu;
|
||
//高度方位角结构体
|
||
typedef struct rah
|
||
{
|
||
double R;
|
||
double A;
|
||
double H;
|
||
}rah, *prah;
|
||
|
||
/* ------------------------ 将字符串转换为浮点数,i起始位置，n输入多少个字符 ----------------------- */
|
||
static double strtonum(const char* buff, int i, int n)
|
||
{
|
||
double value = 0.0;
|
||
char str[256] = { 0 };
|
||
char* p = str;
|
||
/************************************
|
||
* 当出现以下三种情况报错，返回0.0
|
||
* 1.起始位置<0
|
||
* 2.读取字符串个数<i
|
||
* 3.str里面存放的字节数<n
|
||
*************************************/
|
||
if (i < 0 || (int)strlen(buff) < i || (int)sizeof(str) - 1 < n)
|
||
{
|
||
return 0.0;
|
||
}
|
||
for (buff += i; *buff && --n >= 0; buff++)
|
||
{
|
||
//三目操作符：D和d为文件中科学计数法部分，将其转换成二进制能读懂的e
|
||
*p++ = ((*buff == 'D' || *buff == 'd') ? 'e' : *buff);
|
||
}
|
||
*p = '\0';
|
||
//三目操作符，将str中存放的数以格式化读取到value中。
|
||
return sscanf(str, "%lf", &value) == 1 ? value : 0.0;
|
||
}
|
||
|
||
/* -------------------------------- 导航头文件结构体 -------------------------------- */
|
||
typedef struct nav_head
|
||
{
|
||
double ver;//rinex 版本号
|
||
char type[20];//读取的数据类型
|
||
double ION_GPSA[4];//8个电离层参数
|
||
double ION_GPSB[4];
|
||
double ION_BDSA[4];//8个电离层参数
|
||
double ION_BDSB[4];
|
||
double ION_QZSA[4];//8个电离层参数
|
||
double ION_QZSB[4];
|
||
double ION_IRNA[4];//8个电离层参数
|
||
double ION_IRNB[4];
|
||
double GPUT[4];
|
||
double GLUT[4];
|
||
double GAUT[4];
|
||
double BDUT[4];
|
||
double QZUT[4];
|
||
double IRUT[4];
|
||
double SBUT[4];
|
||
int leap;
|
||
}nav_head, *pnav_head;
|
||
|
||
/* --------------------------------- 导航数据结构体 -------------------------------- */
|
||
typedef struct nav_body
|
||
{
|
||
//数据块第一行内容：
|
||
int sPRN;//卫星PRN号
|
||
//历元：TOC中卫星钟的参考时刻
|
||
int TOC_Y;//年
|
||
int TOC_M;//月
|
||
int TOC_D;//日
|
||
int TOC_H;//时
|
||
int TOC_Min;//分
|
||
int TOC_Sec;//秒
|
||
double sa0;//卫星钟差
|
||
double sa1;//卫星钟偏
|
||
double sa2;//卫星钟漂
|
||
|
||
//数据块第二行内容：
|
||
double IODE;//数据、星历发布时间(数据期龄)
|
||
double Crs;//轨道半径的正弦调和改正项的振幅（单位：m）
|
||
double deltan;//卫星平均运动速率与计算值之差(rad/s)
|
||
double M0;//参考时间的平近点角(rad)
|
||
|
||
//数据块第三行内容：
|
||
double Cuc;//维度幅角的余弦调和改正项的振幅(rad)
|
||
double e;//轨道偏心率
|
||
double Cus;//轨道幅角的正弦调和改正项的振幅(rad)
|
||
double sqrtA;//长半轴平方根
|
||
|
||
//数据块第四行内容：
|
||
double TOE;//星历的参考时刻(GPS周内秒)
|
||
double Cic;//轨道倾角的余弦调和改正项的振幅(rad)
|
||
double OMEGA;//参考时刻的升交点赤经
|
||
double Cis;//维度倾角的正弦调和改正项的振幅(rad)
|
||
|
||
//数据块第五行内容：
|
||
double i0;//参考时间的轨道倾角(rad)
|
||
double Crc;//轨道平径的余弦调和改正项的振幅(m)
|
||
double omega;//近地点角距
|
||
double deltaomega;//升交点赤经变化率(rad)
|
||
|
||
//数据块第六行内容：
|
||
double IDOT;//近地点角距(rad/s)
|
||
double L2code;//L2上的码
|
||
double GPSweek;//GPS周,于TOE一同表示
|
||
double L2Pflag;//L2,p码数据标记
|
||
|
||
//数据块第七行内容
|
||
double sACC;//卫星精度
|
||
double sHEA;//卫星健康状态
|
||
double TGD;//sec
|
||
double IODC;//钟的数据龄期
|
||
|
||
//数据块第八行内容
|
||
double TTN;//电文发送时间
|
||
double fit;//拟合区间
|
||
double spare1;//空
|
||
double spare2;//空
|
||
|
||
}nav_body, *pnav_body;
|
||
|
||
/* --------------------------------- 观测值头文件结构体 --------------------------------- */
|
||
typedef struct obs_head
|
||
{
|
||
double ver;//RINEX文件版本号
|
||
char type[30];//文件类型
|
||
double apX;//测站近似位置XYZ（WGS84）
|
||
double apY;
|
||
double apZ;
|
||
double ANTH;//天线高
|
||
double ANTdeltaE;//天线中心对于测站标志在东方向上的偏移量
|
||
double ANTdeltaN;//天线中心对于测站标志在北方向上的偏移量
|
||
int WAFL1;//缺省的L1载波的波长因子
|
||
int WAFL2;//缺省的L2载波的波长因子
|
||
int WAFflag;
|
||
int obstypenum_gps;//GPS观测值类型数量
|
||
int obstypenum_bds;
|
||
char obstype_gps[36];//rinex3.04GPS观测值类型列表
|
||
char obstype_bds[36];
|
||
double interval;//观测值的历元间隔
|
||
int f_y;//第一个观测记录的时刻
|
||
int f_m;
|
||
int f_d;
|
||
int f_h;
|
||
int f_min;
|
||
double f_sec;
|
||
char tsys[5];//时间系统
|
||
}obs_head,*pobs_head;
|
||
|
||
|
||
/* ------------------------------- 观测值历元数据结构体 ------------------------------- */
|
||
typedef struct obs_epoch
|
||
{
|
||
//观测历元时刻
|
||
int y;
|
||
int m;
|
||
int d;
|
||
int h;
|
||
int min;
|
||
double sec;
|
||
int p_flag;//历元标志
|
||
int sat_num;//当前历元所观测到的卫星数量
|
||
int gps_num;//当前历元所观测到的GPS卫星数量
|
||
int bds_num;//当前历元所观测到的BDS卫星数量
|
||
int sPRN[84];//当前历元所能观测到的卫星的PRN列表
|
||
int sPRN_GPS[25];
|
||
int sPRN_BDS[36];
|
||
}obs_epoch,*pobs_epoch;
|
||
|
||
|
||
/* -------------------------------- 观测值数据结构体 -------------------------------- */
|
||
typedef struct obs_body
|
||
{
|
||
double obs_gps[100][24];//GPS观测值
|
||
double obs_bds[100][24];//BDS观测值
|
||
}obs_body,*pobs_body;
|
||
/* -------------------------------------------------------------------------- */
|
||
|
||
|
||
/* -------------------------------------------------------------------------- */
|
||
/* 读取O文件
|
||
/* -------------------------------------------------------------------------- */
|
||
|
||
/* -------------------------------- 获取O文件历元数 -------------------------------- */
|
||
extern int get_epochnum(FILE* fp_obs)
|
||
{
|
||
int n = 0;//记录历元数
|
||
int satnum = 0;//记录每个历元的卫星数
|
||
char flag;//存放标志符号'>'
|
||
char buff[MAXRINEX];//存放读取的字符串
|
||
while (fgets(buff, MAXRINEX, fp_obs))
|
||
{
|
||
satnum = (int)strtonum(buff, 33, 2);
|
||
strncpy(&flag, buff + 0, 1);
|
||
if (flag == '>')
|
||
{
|
||
n++;
|
||
}
|
||
}
|
||
return n;
|
||
}
|
||
|
||
/* -------------------------------- 读取O文件数据头 -------------------------------- */
|
||
extern void read_o_h(FILE* fp_obs, pobs_head obs_h)
|
||
{
|
||
char buff[MAXRINEX] = { 0 };
|
||
char flag = { 0 };
|
||
char* lable = buff + 60;
|
||
int i = 0;
|
||
int j = 0;
|
||
while (fgets(buff, MAXRINEX, fp_obs))
|
||
{
|
||
if (strstr(lable, "RINEX VERSION / TYPE"))
|
||
{
|
||
obs_h->ver = strtonum(buff, 0, 9);
|
||
strncpy(obs_h->type, buff + 20, 30);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "APPROX POSITION XYZ"))
|
||
{
|
||
obs_h->apX = strtonum(buff, 0, 14);
|
||
obs_h->apY = strtonum(buff, 0 + 14, 14);
|
||
obs_h->apZ = strtonum(buff, 0 + 14 + 14, 14);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "ANTENNA: DELTA H/E/N"))
|
||
{
|
||
obs_h->ANTH = strtonum(buff, 0, 14);
|
||
obs_h->ANTdeltaE = strtonum(buff, 14, 14);
|
||
obs_h->ANTdeltaN = strtonum(buff, 14 + 14, 14);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "WAVELENGTH FACT L1/2"))
|
||
{
|
||
obs_h->WAFL1 = (int)strtonum(buff, 0, 6);
|
||
obs_h->WAFL2 = (int)strtonum(buff, 6, 6);
|
||
obs_h->WAFflag = (int)strtonum(buff, 6 + 6, 6);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "SYS / # / OBS TYPES"))
|
||
{
|
||
char flag = {0};
|
||
strncpy(&flag, buff + 0, 1);
|
||
if (flag == 'G')
|
||
{
|
||
obs_h->obstypenum_gps = (int)strtonum(buff, 4, 2);
|
||
if (obs_h->obstypenum_gps <= 13)
|
||
{
|
||
for (i = 0; i < obs_h->obstypenum_gps; i++)
|
||
{
|
||
strncpy(&(obs_h->obstype_gps[i]), buff + 7 + 4 * i, 3);
|
||
}
|
||
}
|
||
else if (obs_h->obstypenum_gps > 13)
|
||
{
|
||
for (i = 0; i < 13; i++)
|
||
{
|
||
strncpy(&(obs_h->obstype_gps[i]), buff + 7 + 4 * i, 3);
|
||
}
|
||
fgets(buff, MAXRINEX, fp_obs);
|
||
for (i = 0; i < obs_h->obstypenum_gps - 13; i++)
|
||
{
|
||
strncpy(&(obs_h->obstype_gps[i + 13]), buff + 7 + 4 * i, 3);
|
||
}
|
||
}
|
||
continue;
|
||
}
|
||
if (flag == 'C')
|
||
{
|
||
obs_h->obstypenum_bds = (int)strtonum(buff, 4, 2);
|
||
if (obs_h->obstypenum_bds <= 13)
|
||
{
|
||
for (i = 0; i < obs_h->obstypenum_bds; i++)
|
||
{
|
||
strncpy(&(obs_h->obstype_bds[i]), buff + 7 + 4 * i, 3);
|
||
}
|
||
}
|
||
else if (obs_h->obstypenum_bds > 13)
|
||
{
|
||
for (i = 0; i < 13; i++)
|
||
{
|
||
strncpy(&(obs_h->obstype_bds[i]), buff + 7 + 4 * i, 3);
|
||
}
|
||
fgets(buff, MAXRINEX, fp_obs);
|
||
for (i = 0; i < obs_h->obstypenum_bds - 13; i++)
|
||
{
|
||
strncpy(&(obs_h->obstype_bds[i + 13]), buff + 7 + 4 * i, 3);
|
||
}
|
||
}
|
||
continue;
|
||
}
|
||
}
|
||
else if (strstr(lable, "INTERVAL"))
|
||
{
|
||
obs_h->interval = strtonum(buff, 0, 11);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "TIME OF FIRST OBS"))
|
||
{
|
||
obs_h->f_y = (int)strtonum(buff, 2, 4);
|
||
obs_h->f_m = (int)strtonum(buff, 2 + 6, 4);
|
||
obs_h->f_d = (int)strtonum(buff, 2 + 6 + 6, 4);
|
||
obs_h->f_h = (int)strtonum(buff, 2 + 6 + 6 + 6, 4);
|
||
obs_h->f_min = (int)strtonum(buff, 2 + 6 + 6 + 6 + 6, 4);
|
||
obs_h->f_sec = strtonum(buff, 2 + 6 + 6 + 6 + 6 + 6, 9);
|
||
strncpy(obs_h->tsys, buff + 6 + 6 + 6 + 6 + 6 + 18, 3);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "END OF HEADER"))
|
||
break;
|
||
}
|
||
}
|
||
|
||
/* -------------------------------- 读取O文件数据块 -------------------------------- */
|
||
extern void read_o_b(FILE* fp_obs, pobs_epoch obs_e, pobs_body obs_b, int type_gps, int type_bds)
|
||
{
|
||
int n = 0;//历元数
|
||
char buff[MAXRINEX] = { 0 };
|
||
char flag = { 0 };//判断符号
|
||
while (fgets(buff, MAXRINEX, fp_obs))
|
||
{
|
||
int i = 0;//第i颗卫星
|
||
int j_g = 0;//第j颗GPS卫星
|
||
int k_g = 0;//第j颗GPS卫星的第k个观测值
|
||
int j_c = 0;//第j颗BDS卫星
|
||
int k_c = 0;//第j颗BDS卫星的第k个观测值
|
||
obs_e[n].gps_num = 0;
|
||
obs_e[n].bds_num = 0;
|
||
|
||
//按照格式将历元参考时间依次存入
|
||
//除秒以外，均转换成整型
|
||
obs_e[n].y = (int)strtonum(buff, 2, 4);
|
||
obs_e[n].m = (int)strtonum(buff, 7, 2);
|
||
obs_e[n].d = (int)strtonum(buff, 10, 2);
|
||
obs_e[n].h = (int)strtonum(buff, 13, 2);
|
||
obs_e[n].min = (int)strtonum(buff, 16, 2);
|
||
obs_e[n].sec = strtonum(buff, 19, 10);
|
||
obs_e[n].p_flag = (int)strtonum(buff, 31, 1);
|
||
//输入卫星数
|
||
obs_e[n].sat_num = strtonum(buff, 33, 3);
|
||
strncpy(&flag, buff + 0, 1);
|
||
|
||
for (i = 0; i < obs_e[n].sat_num; i++)
|
||
{
|
||
//判断是否为GPS卫星
|
||
if (flag == 'G')//获取flag标识，判断GPS卫星为真，读取该卫星PRN号
|
||
{
|
||
obs_e[n].sPRN[i] = strtonum(buff, 1, 2);//将卫星编号存储到第n个历元中，第i个PRN位置
|
||
obs_e[n].sPRN_GPS[j_g] = obs_e[n].sPRN[i];//将GPS卫星编号与总观测卫星号关联
|
||
for (k_g = 0; k_g < type_gps; k_g++)
|
||
{
|
||
obs_b[n].obs_gps[j_g][k_g] = strtonum(buff, 3 + 16 * k_g, 14);
|
||
}
|
||
obs_e[n].gps_num++; j_g++;
|
||
fgets(buff, MAXRINEX, fp_obs);
|
||
strncpy(&flag, buff + 0, 1);
|
||
}
|
||
|
||
else if (flag != 'G')//获取flag标识，判断GPS卫星为否
|
||
{
|
||
//判断是否为BDS卫星
|
||
if (flag == 'C')//获取flag标识，判断BDS卫星为真，读取该卫星PRN号
|
||
{
|
||
obs_e[n].sPRN[i] = strtonum(buff, 1, 2);//将卫星编号存储到第n个历元中，第i个PRN位置
|
||
obs_e[n].sPRN_BDS[j_c] = obs_e[n].sPRN[i];//将BDS卫星编号与总观测卫星号关联
|
||
for (k_c = 0; k_c < type_bds; k_c++)
|
||
{
|
||
obs_b[n].obs_bds[j_c][k_c] = strtonum(buff, 3 + 16 * k_c, 14);
|
||
}
|
||
obs_e[n].bds_num++; j_c++;
|
||
fgets(buff, MAXRINEX, fp_obs);
|
||
strncpy(&flag, buff + 0, 1);
|
||
}
|
||
|
||
else if (flag != 'C')//获取flag标识，判断BDS卫星为真，读取该卫星PRN号
|
||
{
|
||
fgets(buff, MAXRINEX, fp_obs);
|
||
strncpy(&flag, buff + 0, 1);
|
||
}
|
||
}
|
||
|
||
}
|
||
n++;
|
||
}
|
||
|
||
}
|
||
|
||
/* -------------------------------------------------------------------------- */
|
||
/* 读取N文件
|
||
/* -------------------------------------------------------------------------- */
|
||
|
||
/* ---------------------- 获取文件数据块行数，从END OF HEADER后开始起算 --------------------- */
|
||
extern int getgpssatnum(FILE* fp_nav)
|
||
{
|
||
int gps_satnum = 0;
|
||
int flag = 0;
|
||
char buff[MAXRINEX];//用来存放读取到的字符串
|
||
char satvar;
|
||
char* lable = buff + 60;
|
||
//fgets函数，读取一行，当读取结束后返回NULL指针，格式如下：
|
||
//char * fgets ( char * str, int num, FILE * stream );
|
||
while (fgets(buff, MAXRINEX, fp_nav))
|
||
{
|
||
if (flag == 1)
|
||
{
|
||
while (fgets(buff, MAXRINEX, fp_nav))
|
||
{
|
||
strncpy(&satvar, buff + 0, 1);
|
||
if (satvar != 'G')
|
||
{
|
||
continue;
|
||
}
|
||
else if (satvar == 'G')
|
||
{
|
||
gps_satnum++;
|
||
break;
|
||
}
|
||
}
|
||
|
||
}
|
||
|
||
if (strstr(lable, "END OF HEADER"))
|
||
{
|
||
flag = 1;
|
||
}
|
||
}
|
||
return gps_satnum;
|
||
}
|
||
|
||
/* -------------------------------- 读取N文件数据头 -------------------------------- */
|
||
void read_n_h(FILE* fp_nav, pnav_head nav_h)
|
||
{
|
||
char buff[MAXRINEX] = { 0 };
|
||
char* lable = buff;
|
||
int i = 0;
|
||
int j = 0;
|
||
while (fgets(buff, MAXRINEX, fp_nav))
|
||
{
|
||
if (strstr(lable, "RINEX VERSION / TYPE"))
|
||
{
|
||
nav_h->ver = strtonum(buff, 0, 9);
|
||
strncpy((nav_h->type), buff + 20, 15);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "GPSA"))
|
||
{
|
||
nav_h->ION_GPSA[0] = strtonum(buff, 6, 12);
|
||
nav_h->ION_GPSA[1] = strtonum(buff, 6 + 12, 12);
|
||
nav_h->ION_GPSA[2] = strtonum(buff, 6 + 12 + 12, 12);
|
||
nav_h->ION_GPSA[3] = strtonum(buff, 6 + 12 + 12 + 12, 12);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "GPSB"))
|
||
{
|
||
nav_h->ION_GPSB[0] = strtonum(buff, 6, 12);
|
||
nav_h->ION_GPSB[1] = strtonum(buff, 6 + 12, 12);
|
||
nav_h->ION_GPSB[2] = strtonum(buff, 6 + 12 + 12, 12);
|
||
nav_h->ION_GPSB[3] = strtonum(buff, 6 + 12 + 12 + 12, 12);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "BDSA"))
|
||
{
|
||
nav_h->ION_BDSA[0] = strtonum(buff, 6, 12);
|
||
nav_h->ION_BDSA[1] = strtonum(buff, 6 + 12, 12);
|
||
nav_h->ION_BDSA[2] = strtonum(buff, 6 + 12 + 12, 12);
|
||
nav_h->ION_BDSA[3] = strtonum(buff, 6 + 12 + 12 + 12, 12);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "BDSB"))
|
||
{
|
||
nav_h->ION_BDSB[0] = strtonum(buff, 6, 12);
|
||
nav_h->ION_BDSB[1] = strtonum(buff, 6 + 12, 12);
|
||
nav_h->ION_BDSB[2] = strtonum(buff, 6 + 12 + 12, 12);
|
||
nav_h->ION_BDSB[3] = strtonum(buff, 6 + 12 + 12 + 12, 12);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "BDUT"))
|
||
{
|
||
nav_h->BDUT[0] = strtonum(buff, 5, 17);
|
||
nav_h->BDUT[1] = strtonum(buff, 5 + 17, 16);
|
||
nav_h->BDUT[2] = strtonum(buff, 5 + 17 + 16, 7);
|
||
nav_h->BDUT[3] = strtonum(buff, 5 + 17 + 16 + 7, 5);
|
||
continue;
|
||
}
|
||
else if (strstr(lable, "GPUT"))
|
||
{
|
||
nav_h->GPUT[0] = strtonum(buff, 5, 17);
|
||
nav_h->GPUT[1] = strtonum(buff, 5 + 17, 16);
|
||
nav_h->GPUT[2] = strtonum(buff, 5 + 17 + 16, 7);
|
||
nav_h->GPUT[3] = strtonum(buff, 5 + 17 + 16 + 7, 5);
|
||
continue;
|
||
}
|
||
|
||
else if (strstr(lable, "LEAP SECONDS"))
|
||
{
|
||
nav_h->leap = (int)strtonum(buff, 4, 2);
|
||
}
|
||
else if (strstr(lable, "END OF HEADER"))//头文件读取结束
|
||
break;
|
||
}
|
||
}
|
||
|
||
/* -------------------------------- 读取N文件数据块 -------------------------------- */
|
||
void read_n_b(FILE* fp_nav, pnav_body nav_b)
|
||
{
|
||
int i_g = 0;//第i_g个GPS卫星数据
|
||
int i_c = 0;//第i_c个BDS卫星数据
|
||
char buff[84] = { 0 };
|
||
char flag = { 0 };//判断符号
|
||
while (fgets(buff, MAXRINEX, fp_nav))
|
||
{
|
||
int j_g = 0;//数据块的第j_g行数据
|
||
int j_c = 0;//数据块的第j_C行数据
|
||
strncpy(&flag, buff + 0, 1);
|
||
if(flag == 'G')
|
||
{
|
||
for (j_g = 0; j_g < 8; j_g++)//读取第i_g颗 GPS卫星广播星历("总共包含8行数据") 数据块的第j_g行数据
|
||
{
|
||
switch (j_g)
|
||
{
|
||
case 0:
|
||
nav_b[i_g].sPRN = (int)strtonum(buff, 1, 2);
|
||
nav_b[i_g].TOC_Y = (int)strtonum(buff, 4, 4);
|
||
nav_b[i_g].TOC_M = (int)strtonum(buff, 9, 2);
|
||
nav_b[i_g].TOC_D = (int)strtonum(buff, 12, 2);
|
||
nav_b[i_g].TOC_H = (int)strtonum(buff, 15, 2);
|
||
nav_b[i_g].TOC_Min = (int)strtonum(buff, 18, 2);
|
||
nav_b[i_g].TOC_Sec = strtonum(buff, 21, 2);
|
||
nav_b[i_g].sa0 = strtonum(buff, 23, 19);
|
||
nav_b[i_g].sa1 = strtonum(buff, 23 + 19, 19);
|
||
nav_b[i_g].sa2 = strtonum(buff, 23 + 19 + 19, 19);
|
||
fgets(buff, MAXRINEX, fp_nav);
|
||
break;
|
||
case 1:
|
||
nav_b[i_g].IODE = strtonum(buff, 4, 19);
|
||
nav_b[i_g].Crs = strtonum(buff, 4 + 19, 19);
|
||
nav_b[i_g].deltan = strtonum(buff, 4 + 19 + 19, 19);
|
||
nav_b[i_g].M0 = strtonum(buff, 4 + 19 + 19 + 19, 19);
|
||
fgets(buff, MAXRINEX, fp_nav);
|
||
break;
|
||
case 2:
|
||
nav_b[i_g].Cuc = strtonum(buff, 4, 19);
|
||
nav_b[i_g].e = strtonum(buff, 4 + 19, 19);
|
||
nav_b[i_g].Cus = strtonum(buff, 4 + 19 + 19, 19);
|
||
nav_b[i_g].sqrtA = strtonum(buff, 4 + 19 + 19 + 19, 19);
|
||
fgets(buff, MAXRINEX, fp_nav);
|
||
break;
|
||
case 3:
|
||
nav_b[i_g].TOE = strtonum(buff, 4, 19);
|
||
nav_b[i_g].Cic = strtonum(buff, 4 + 19, 19);
|
||
nav_b[i_g].OMEGA = strtonum(buff, 4 + 19 + 19, 19);
|
||
nav_b[i_g].Cis = strtonum(buff, 4 + 19 + 19 + 19, 19);
|
||
fgets(buff, MAXRINEX, fp_nav);
|
||
break;
|
||
case 4:
|
||
nav_b[i_g].i0 = strtonum(buff, 4, 19);
|
||
nav_b[i_g].Crc = strtonum(buff, 4 + 19, 19);
|
||
nav_b[i_g].omega = strtonum(buff, 4 + 19 + 19, 19);
|
||
nav_b[i_g].deltaomega = strtonum(buff, 4 + 19 + 19 + 19, 19);
|
||
fgets(buff, MAXRINEX, fp_nav);
|
||
break;
|
||
case 5:
|
||
nav_b[i_g].IDOT = strtonum(buff, 4, 19);
|
||
nav_b[i_g].L2code = strtonum(buff, 4 + 19, 19);
|
||
nav_b[i_g].GPSweek= strtonum(buff, 4 + 19 + 19, 19);
|
||
nav_b[i_g].L2Pflag = strtonum(buff, 4 + 19 + 19 + 19, 19);
|
||
fgets(buff, MAXRINEX, fp_nav);
|
||
break;
|
||
case 6:
|
||
nav_b[i_g].sACC = strtonum(buff, 4, 19);
|
||
nav_b[i_g].sHEA = strtonum(buff, 4 + 19, 19);
|
||
nav_b[i_g].TGD = strtonum(buff, 4 + 19 + 19, 19);
|
||
nav_b[i_g].IODC = strtonum(buff, 4 + 19 + 19 + 19, 19);
|
||
fgets(buff, MAXRINEX, fp_nav);
|
||
break;
|
||
case 7:
|
||
nav_b[i_g].TTN = strtonum(buff, 4, 19);
|
||
nav_b[i_g].fit = strtonum(buff, 4 + 19, 19);
|
||
nav_b[i_g].spare1 = strtonum(buff, 4 + 19 + 19, 19);
|
||
nav_b[i_g].spare2 = strtonum(buff, 4 + 19 + 19 + 19, 19);
|
||
break;
|
||
}
|
||
}
|
||
i_g++;
|
||
continue;
|
||
}
|
||
else if(flag != 'G')
|
||
{
|
||
fgets(buff, MAXRINEX, fp_nav);
|
||
continue;
|
||
}
|
||
}
|
||
}
|
||
/* -------------------------------------------------------------------------- */
|
||
|
||
#endif |