GPS卫星定位—python实现

  基于导航文件的GPS定位——python实现 

模型建立：

 

前几天的文章由于第一次太激动而没有完全搞定，这次提交最新版本！！

# coding:utf-8
import os
import math as m
with open('brdm0320.22p','r') as f:
    data=f.readlines()
    # print(data)
    f.close()
#文件时间不同可取消此处注释
# def o_data_line():
#     for i in range(len(data)):
#         if data[i].find('END OF HEADER') != -1:
#             o_data_line = i + 1
#     return o_data_line
# print(o_data_line())
ff=[]
ff=data[207:3359]
# print(ff)

file_write_obj = open("GPS_data.txt", 'w')   # 新文件写入GPS_data
for i in range(3359-207) :
    file_write_obj.write(ff[i])   # 逐行写入
    # file_write_obj.write('\n')
file_write_obj.close()
print("保存文件成功")

#文件读取
with open('GPS_data.txt','r') as G:

    GPS_data=G.readlines()
    f.close()
    # print(GPS_data)
data_num=int(len(GPS_data)/8)         #数据组数
# print(data_num)


PRN = []
year = []
day=[]
month=[]
hour = []
minute=[]
second=[]
S=[]
S_s=[]
S_ss=[]
IODE=[]
C_rs=[]
n=[]
mo=[]
C_uc=[]
e=[]
C_us=[]
sqrt_A=[]
TEO=[]
C_ic=[]
C_is=[]
OMEGA=[]
I_0=[]
C_rc=[]
w=[]
OMEGA_DOT=[]
IDOT=[]
L2_code = []
PS_week_num=[]
L2_P_code=[]
TGD=[]
IODC=[]
for j in range(data_num):

    for i in range(8):
        data_l = GP