KenanZhu/KNZ_GeoTrackLab
Archived
1
0 Fork 0
Code Issues Actions Packages Projects Releases Wiki Activity

modified some unuseful definition

Browse Source
This commit is contained in:
KenanZhu111 committed 2024-09-26 18:47:08 +08:00
1 parent dbecbe95cb
commit cba65f6a85
7 files changed
+111 -57
Download Patch File Download Diff File Expand all files Collapse all files

No files matched your search

headers/cal_mod.h
+10 -8
View File
@@ -6,17 +6,17 @@
#include"public.h"
#include"read.h"
#include"2gpst.h"
#include"select_epo.h"
#include"rahcal.h"
#include"xyz2blh.h"
#include"degRrad.h"
#include"deg2dms.h"
#include"blh2enu.h"
#include"rahcal.h"
#include"type2code.h"
#include"select_epo.h"
/* ------------------------------- GPS卫星位置计算函数 ------------------------------ */
int gps_pos(int eponum, int sPRN, int best_epoch, double GPSsec,
void gps_pos(int eponum, int sPRN, int best_epoch, double GPSsec,
pnav_body nav_b, pobs_head obs_h, ppos_t pos_t)
{
double T_S = GPSsec - pos_t[eponum].deltat[sPRN];//计算信号发射时刻
@@ -64,7 +64,7 @@ int gps_pos(int eponum, int sPRN, int best_epoch, double GPSsec,
/* ------------------------------- GPS卫星位置计算&输出 ------------------------------ */
int sat_gps_pos_clac(FILE * result_file,
void sat_gps_pos_clac(FILE * result_file,
pnav_body nav_b, pobs_epoch obs_e, pobs_body obs_b,
pobs_head obs_h, pstation station, ppos_t pos_t,
pblh blh, penu enu, prah rah,
@@ -109,7 +109,7 @@ int sat_gps_pos_clac(FILE * result_file,
station[i].delta_TR == 0.0;
//计算近似的信号传播时间,接收机钟差已初始化为0(伪距/光速-接收机钟差+卫星钟差)
pos_t[i].delta_t[sPRN] = (obs_b[i].obs_gps[j][C1] / C_V) - station[i].delta_TR + nav_b[best_epoch].sa0 + nav_b[best_epoch].sa1 * detat_toc + nav_b[best_epoch].sa2 * pow(detat_toc, 2);
pos_t[i].delta_t[sPRN] = (obs_b[i].obs_gps[j][Code2Type(C1C, obs_h->obstypenum_gps, obs_h->obscode_gps)] / C_V) - station[i].delta_TR + nav_b[best_epoch].sa0 + nav_b[best_epoch].sa1 * detat_toc + nav_b[best_epoch].sa2 * pow(detat_toc, 2);
//判断收敛
pos_t[i].deltat[sPRN] = 0.0;
@@ -171,7 +171,10 @@ int sat_gps_pos_clac(FILE * result_file,
fclose(result_file);
result_file = fopen(".\\Result_out\\LLA_result.txt", "a+");
fprintf(result_file, "\nG%02d[sPRN] %15.05f %15.05f %15.05f %15.05f %15.05f %15.05f %15.12f %16.13f"
,sPRN, pos_t[i].X[sPRN], pos_t[i].Y[sPRN], pos_t[i].Z[sPRN], obs_b[i].obs_gps[j][C1], obs_b[i].obs_gps[j][10], rah->H, nav_b[best_epoch].TGD, pos_t[i].delta_clk[sPRN]);
,sPRN, pos_t[i].X[sPRN], pos_t[i].Y[sPRN], pos_t[i].Z[sPRN]
,obs_b[i].obs_gps[j][Code2Type(C1C, obs_h->obstypenum_gps, obs_h->obscode_gps)]
,obs_b[i].obs_gps[j][Code2Type(C2L, obs_h->obstypenum_gps, obs_h->obscode_gps)]
,rah->H, nav_b[best_epoch].TGD, pos_t[i].delta_clk[sPRN]);
fclose(result_file);
}
@@ -207,7 +210,6 @@ int sat_gps_pos_clac(FILE * result_file,
free(rah);rah = NULL;
free(pos_t);pos_t = NULL;
free(station);station = NULL;
return 1;
}
#endif
headers/public.h
+23 -27
View File
@@ -9,29 +9,28 @@
#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 C1C 1
#define C1S 2
#define C1L 3
#define C1X 4
#define C1P 5
#define C1W 6
#define C1Y 7
#define C1M 8
#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 C2C 9
#define C2S 10
#define C2L 11
#define C2X 12
#define C2P 13
#define C2W 14
#define C2Y 15
#define C2M 16
#define C5I 501
#define C5Q 502
#define C5X 503
#define C5I 17
#define C5Q 18
#define C5X 19
/* ------------------------------ FOR CALMOD.H ------------------------------ */
#define MAXRINEX 1000
//卫星位置结构体
@@ -70,14 +69,14 @@
double H;
}blh, *pblh;
//东北天结构体
typedef struct enu
typedef struct
{
double E;
double N;
double U;
}enu, *penu;
//高度方位角结构体
typedef struct rah
typedef struct
{
double R;
double A;
@@ -178,13 +177,10 @@ typedef struct obs_head
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];
int obscode_gps[36];//rinex3.04GPS观测值类型列表
int obscode_bds[36];
double interval;//观测值的历元间隔
int f_y;//第一个观测记录的时刻
int f_m;
headers/read.h
+11 -21
View File
@@ -1,10 +1,10 @@
#ifndef _READ_H_
#define _READ_H_
#include<stdio.h>
#include<string.h>
#include"public.h"
#include"type2code.h"
/* ------------------------ 将字符串转换为浮点数,i起始位置，n输入多少个字符 ----------------------- */
static double strtonum(const char* buff, int i, int n)
{
@@ -84,13 +84,6 @@ extern void read_o_h(FILE* fp_obs, pobs_head obs_h)
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};
@@ -102,19 +95,19 @@ extern void read_o_h(FILE* fp_obs, pobs_head obs_h)
{
for (i = 0; i < obs_h->obstypenum_gps; i++)
{
strncpy(&(obs_h->obstype_gps[i]), buff + 7 + 4 * i, 3);
obs_h->obscode_gps[i] = Type2Code(i, buff);
}
}
else if (obs_h->obstypenum_gps > 13)
{
for (i = 0; i < 13; i++)
{
strncpy(&(obs_h->obstype_gps[i]), buff + 7 + 4 * i, 3);
obs_h->obscode_gps[i] = Type2Code(i, buff);
}
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);
obs_h->obscode_gps[i + 13] = Type2Code(i, buff);
}
}
continue;
@@ -126,19 +119,19 @@ extern void read_o_h(FILE* fp_obs, pobs_head obs_h)
{
for (i = 0; i < obs_h->obstypenum_bds; i++)
{
strncpy(&(obs_h->obstype_bds[i]), buff + 7 + 4 * i, 3);
obs_h->obscode_bds[i] = Type2Code(i, buff);
}
}
else if (obs_h->obstypenum_bds > 13)
{
for (i = 0; i < 13; i++)
{
strncpy(&(obs_h->obstype_bds[i]), buff + 7 + 4 * i, 3);
obs_h->obscode_bds[i] = Type2Code(i, buff);
}
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);
obs_h->obscode_bds[i + 13] = Type2Code(i, buff);
}
}
continue;
@@ -213,7 +206,7 @@ extern void read_o_b(FILE* fp_obs, pobs_epoch obs_e, pobs_body obs_b, int type_g
else if (flag != 'G')//获取flag标识，判断GPS卫星为否
{
//判断是否为BDS卫星
if (flag == 'C')//获取flag标识，判断BDS卫星为真，读取该卫星PRN号
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卫星编号与总观测卫星号关联
@@ -232,11 +225,9 @@ extern void read_o_b(FILE* fp_obs, pobs_epoch obs_e, pobs_body obs_b, int type_g
strncpy(&flag, buff + 0, 1);
}
}
}
n++;
}
}
}
/* -------------------------------------------------------------------------- */
@@ -244,7 +235,7 @@ extern void read_o_b(FILE* fp_obs, pobs_epoch obs_e, pobs_body obs_b, int type_g
/* -------------------------------------------------------------------------- */
/* ---------------------- 获取文件数据块行数，从END OF HEADER后开始起算 --------------------- */
extern int getgpssatnum(FILE* fp_nav)
int getgpssatnum(FILE* fp_nav)
{
int gps_satnum = 0;
int flag = 0;
@@ -269,8 +260,7 @@ extern int getgpssatnum(FILE* fp_nav)
gps_satnum++;
break;
}
}
}
}
if (strstr(lable, "END OF HEADER"))
headers/type2code.h
+59
View File
@@ -0,0 +1,59 @@
#ifndef _TYPE2CODE_H_
#define _TYPE2CODE_H_
#include<string.h>
#include<stdio.h>
#include"public.h"
/* -------------------------------------------------------------------------- */
/// @brief 将观测值类型转换为PUBLIC.H中定义的数字代码
/// @param i 读取循环中传入的循环次数
/// @param buff 传入的观测值类型
/// @return 返回观测值代码
/* -------------------------------------------------------------------------- */
int Type2Code(int i, char buff[1000])
{
int code_return = 0;
char code_contrast[4];
char code_original[4];
for(int j = 0; j < 19; j++)
{
memset(code_contrast,0,sizeof(code_contrast));
memset(code_original,0,sizeof(code_original));
const char codeindex[]="C1CC1SC1LC1XC1PC1WC1YC1M"
"C2CC2SC2LC2XC2PC2WC2YC2M"
"C5IC5QC5X";
strncpy(code_contrast, codeindex + 0 + j * 3 , 3);
strncpy(code_original, buff + 7 + 4 * i , 3);
if(strcmp(code_contrast,code_original) == 0)
{
code_return = j + 1;
break;
}
}
return code_return;
}
/* -------------------------------------------------------------------------- */
/// @brief 将读取的观测值类型匹配类型代码存储数组
/// @param typecode 希望匹配的观测值
/// @param typenum 观测值类型总数量
/// @param typearr 类型代码存储数组
/// @return 返回对应的观测值类型代码的数组位置
/* -------------------------------------------------------------------------- */
int Code2Type(int typecode, int typenum, int typearr[36])
{
int pos;
for(pos = 0; pos < typenum; pos++)
{
if(typearr[pos] == typecode)
{
break;
}
}
return pos;
}
#endif