Modify

headers/select_epo.h

@@ -0,0 +1,37 @@
+#ifndef _SELECT_EPO_H_
+#define _SELECT_EPO_H_
+
+#include<math.h>
+
+#include"public.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