modified the crash

This commit is contained in:
KenanZhu111 committed 2024-09-23 09:59:40 +08:00
1 parent 54547f9d3e
commit b8a6cf4e6e
6 files changed
+54 -63

No files matched your search

+7 -8
View File
@@ -9,7 +9,7 @@ typedef struct
double E;
double N;
double U;
}blh2enu, *pblh2enu;
}blh2enu;
/* -------------------------------------------------------------------------- */
/// @brief 将大地高坐标转换为站心坐标
@@ -21,18 +21,17 @@ typedef struct
/// @param deltaz 卫星到站心的z坐标差值
/// @return 返回自定义结构体类型包含E, N, U成员
/* -------------------------------------------------------------------------- */
pblh2enu BLH2ENU(pblh2enu blh2enu,
double stationB, double stationL,
double deltax, double deltay, double deltaz)
blh2enu BLH2ENU(blh2enu blh2enu,
double stationB, double stationL,
double deltax, double deltay, double deltaz)
{
double sinB = sin(stationB);
double cosB = cos(stationB);
double sinL = sin(stationL);
double cosL = cos(stationL);
blh2enu = (pblh2enu)malloc(sizeof(pblh2enu));
blh2enu->E = - sinL*(deltax) + cosL*(deltay);
blh2enu->N = -sinB*cosL*(deltax) - sinB*sinL*(deltay) + cosB*(deltaz);
blh2enu->U = cosB*cosL*(deltax) + cosB*sinL*(deltay) + sinB*(deltaz);
blh2enu.E = - sinL*(deltax) + cosL*(deltay);
blh2enu.N = -sinB*cosL*(deltax) - sinB*sinL*(deltay) + cosB*(deltaz);
blh2enu.U = cosB*cosL*(deltax) + cosB*sinL*(deltay) + sinB*(deltaz);
return blh2enu;
}