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
+108 -54
Download Patch File Download Diff File Expand all files Collapse all files

No files matched your search

PyGMT_out/.idea/.name
Generated
+1
View File
@@ -0,0 +1 @@
pyGMT.py
PyGMT_out/.idea/vcs.xml
Generated
+6
View File
@@ -0,0 +1,6 @@
<?xml version="1.0" encoding="UTF-8"?>
<project version="4">
<component name="VcsDirectoryMappings">
<mapping directory="$PROJECT_DIR$/.." vcs="Git" />
</component>
</project>
PyGMT_out/pyGMT.py
+1 -1
View File
@@ -9,7 +9,7 @@ import pygmt
fig = pygmt.Figure() fig = pygmt.Figure()
fig.coast(region="d",projection="Cyl_stere/12c",land="white",water="#C6E2FF",borders="1/0.2p",shorelines="1/0.2p",frame="ag") fig.coast(region="d",projection="Cyl_stere/12c",land="white",water="#C6E2FF",borders="1/0.2p",shorelines="1/0.2p",frame="ag")
f = open("LLA_result_for_PyGMT.txt","r") f = open("LLA_result.txt","r")
f.readline() f.readline()
string = f.readline() string = f.readline()
epoch = 0 epoch = 0
headers/cal_mod.h
+10 -8
View File
@@ -6,17 +6,17 @@
#include"public.h" #include"public.h"
#include"read.h"
#include"2gpst.h" #include"2gpst.h"
#include"select_epo.h" #include"rahcal.h"
#include"xyz2blh.h" #include"xyz2blh.h"
#include"degRrad.h" #include"degRrad.h"
#include"deg2dms.h" #include"deg2dms.h"
#include"blh2enu.h" #include"blh2enu.h"
#include"rahcal.h" #include"type2code.h"
#include"select_epo.h"
/* ------------------------------- GPS卫星位置计算函数 ------------------------------ */ /* ------------------------------- 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) pnav_body nav_b, pobs_head obs_h, ppos_t pos_t)
{ {
double T_S = GPSsec - pos_t[eponum].deltat[sPRN];//计算信号发射时刻 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卫星位置计算&输出 ------------------------------ */ /* ------------------------------- 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, pnav_body nav_b, pobs_epoch obs_e, pobs_body obs_b,
pobs_head obs_h, pstation station, ppos_t pos_t, pobs_head obs_h, pstation station, ppos_t pos_t,
pblh blh, penu enu, prah rah, pblh blh, penu enu, prah rah,
@@ -109,7 +109,7 @@ int sat_gps_pos_clac(FILE * result_file,
station[i].delta_TR == 0.0; station[i].delta_TR == 0.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; pos_t[i].deltat[sPRN] = 0.0;
@@ -171,7 +171,10 @@ int sat_gps_pos_clac(FILE * result_file,
fclose(result_file); fclose(result_file);
result_file = fopen(".\\Result_out\\LLA_result.txt", "a+"); 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" 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); fclose(result_file);
} }
@@ -207,7 +210,6 @@ int sat_gps_pos_clac(FILE * result_file,
free(rah);rah = NULL; free(rah);rah = NULL;
free(pos_t);pos_t = NULL; free(pos_t);pos_t = NULL;
free(station);station = NULL; free(station);station = NULL;
return 1;
} }
#endif #endif
headers/public.h
+23 -27
View File
@@ -9,29 +9,28 @@
#define math_e 2.718281828459 #define math_e 2.718281828459
#define PI 3.141592653589793 #define PI 3.141592653589793
#define Earth_e 7.2921151467e-5 #define Earth_e 7.2921151467e-5
#define C1 0
/* ----------------------------- GPS OBSERV TYPE ---------------------------- */ /* ----------------------------- GPS OBSERV TYPE ---------------------------- */
#define C1C 101 #define C1C 1
#define C1S 102 #define C1S 2
#define C1L 103 #define C1L 3
#define C1X 104 #define C1X 4
#define C1P 105 #define C1P 5
#define C1W 106 #define C1W 6
#define C1Y 107 #define C1Y 7
#define C1M 108 #define C1M 8
#define C2C 201 #define C2C 9
#define C2S 202 #define C2S 10
#define C2L 203 #define C2L 11
#define C2X 204 #define C2X 12
#define C2P 205 #define C2P 13
#define C2W 206 #define C2W 14
#define C2Y 207 #define C2Y 15
#define C2M 208 #define C2M 16
#define C5I 501 #define C5I 17
#define C5Q 502 #define C5Q 18
#define C5X 503 #define C5X 19
/* ------------------------------ FOR CALMOD.H ------------------------------ */ /* ------------------------------ FOR CALMOD.H ------------------------------ */
#define MAXRINEX 1000 #define MAXRINEX 1000
//卫星位置结构体 //卫星位置结构体
@@ -70,14 +69,14 @@
double H; double H;
}blh, *pblh; }blh, *pblh;
//东北天结构体 //东北天结构体
typedef struct enu typedef struct
{ {
double E; double E;
double N; double N;
double U; double U;
}enu, *penu; }enu, *penu;
//高度方位角结构体 //高度方位角结构体
typedef struct rah typedef struct
{ {
double R; double R;
double A; double A;
@@ -178,13 +177,10 @@ typedef struct obs_head
double ANTH;//天线高 double ANTH;//天线高
double ANTdeltaE;//天线中心对于测站标志在东方向上的偏移量 double ANTdeltaE;//天线中心对于测站标志在东方向上的偏移量
double ANTdeltaN;//天线中心对于测站标志在北方向上的偏移量 double ANTdeltaN;//天线中心对于测站标志在北方向上的偏移量
int WAFL1;//缺省的L1载波的波长因子
int WAFL2;//缺省的L2载波的波长因子
int WAFflag;
int obstypenum_gps;//GPS观测值类型数量 int obstypenum_gps;//GPS观测值类型数量
int obstypenum_bds; int obstypenum_bds;
char obstype_gps[36];//rinex3.04GPS观测值类型列表 int obscode_gps[36];//rinex3.04GPS观测值类型列表
char obstype_bds[36]; int obscode_bds[36];
double interval;//观测值的历元间隔 double interval;//观测值的历元间隔
int f_y;//第一个观测记录的时刻 int f_y;//第一个观测记录的时刻
int f_m; int f_m;
headers/read.h
+8 -18
View File
@@ -1,10 +1,10 @@
#ifndef _READ_H_ #ifndef _READ_H_
#define _READ_H_ #define _READ_H_
#include<stdio.h> #include<stdio.h>
#include<string.h> #include<string.h>
#include"public.h" #include"public.h"
#include"type2code.h"
/* ------------------------ 将字符串转换为浮点数,i起始位置，n输入多少个字符 ----------------------- */ /* ------------------------ 将字符串转换为浮点数,i起始位置，n输入多少个字符 ----------------------- */
static double strtonum(const char* buff, int i, int 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); obs_h->ANTdeltaN = strtonum(buff, 14 + 14, 14);
continue; 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")) else if (strstr(lable, "SYS / # / OBS TYPES"))
{ {
char flag = {0}; 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++) 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) else if (obs_h->obstypenum_gps > 13)
{ {
for (i = 0; i < 13; i++) 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); fgets(buff, MAXRINEX, fp_obs);
for (i = 0; i < obs_h->obstypenum_gps - 13; i++) 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; 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++) 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) else if (obs_h->obstypenum_bds > 13)
{ {
for (i = 0; i < 13; i++) 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); fgets(buff, MAXRINEX, fp_obs);
for (i = 0; i < obs_h->obstypenum_bds - 13; i++) 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; continue;
@@ -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); strncpy(&flag, buff + 0, 1);
} }
} }
} }
n++; 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后开始起算 --------------------- */ /* ---------------------- 获取文件数据块行数，从END OF HEADER后开始起算 --------------------- */
extern int getgpssatnum(FILE* fp_nav) int getgpssatnum(FILE* fp_nav)
{ {
int gps_satnum = 0; int gps_satnum = 0;
int flag = 0; int flag = 0;
@@ -270,7 +261,6 @@ extern int getgpssatnum(FILE* fp_nav)
break; break;
} }
} }
} }
if (strstr(lable, "END OF HEADER")) 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