Archived
37 lines
968 B
C
37 lines
968 B
C
#ifndef _SELECT_EPO_H_
|
|
#define _SELECT_EPO_H_
|
|
|
|
#include<math.h>
|
|
|
|
#include"read.h"
|
|
|
|
/* -------------------------------------------------------------------------- */
|
|
/// @brief 寻找与观测历元最近的卫星广播历元
|
|
/// @param SecofWeek 计算得到的观测历元的周内秒
|
|
/// @param sPRN 需要匹配的该历元卫星号
|
|
/// @param nav_b 导航文件数据块结构体，与卫星号匹配
|
|
/// @param gps_satnum 该历元的GPS卫星数量
|
|
/// @return 返回最佳历元的绝对历元序号
|
|
/* -------------------------------------------------------------------------- */
|
|
extern int select_epoch(double SecofWeek, int sPRN, pnav_body nav_b, int gps_satnum)
|
|
{
|
|
int best_epoch = 0;
|
|
double min = 10000;//初始化最小值
|
|
double Min;
|
|
int i;
|
|
for (i = 0; i < gps_satnum; i++)
|
|
{
|
|
if (sPRN == nav_b[i].sPRN)
|
|
{
|
|
Min = fabs(SecofWeek - nav_b[i].TOE);
|
|
if (Min <= min)
|
|
{
|
|
best_epoch = i;
|
|
min = Min;
|
|
}
|
|
}
|
|
}
|
|
return best_epoch;
|
|
}
|
|
|
|
#endif |