forked from mfkiwl/GNSS_Programming
-
Notifications
You must be signed in to change notification settings - Fork 0
/
0508.py
94 lines (71 loc) · 4.17 KB
/
0508.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
import datetime
import math
import numpy as np
import RTK2
from utils.const import *
import SinglePointPosition as SPP
import utils.SatellitePosition as SatellitePosition
import utils.CoorTransform as CoorTransform
import RTK
import utils.LAMBDA as LAMBDA
import utils.CycleslipsDetection as CycleslipsDetection
import utils.DoFile as DoFile
import utils.ResultAnalyse as ResultAnalyse
import utils.TimeSystem as TimeSystem
import utils.PictureResults as PictureResults
if __name__ == "__main__":
station1_observation_file = r"edata\attitude_project\rinex2\cuaa0030.21o" # 已知站点 cuaa
# station2_observation_file = r"edata\attitude_project\rinex2\cubb0030.21o" # 未知站点 cubb
# station2_observation_file = r"edata\attitude_project\rinex2\cucc0030.21o" # 未知站点 cucc
station2_observation_file = r"edata\attitude_project\rinex2\cut00030.21o" # 未知站点 cut0
# station1_observation_file = r"edata\obs\zim23100.20o" # 已知站点 zim2
# station2_observation_file = r"edata\obs\zimm3100.20o" # 未知站点 zimm
# station1_observation_file = r"edata\obs\wab23100.20o" # 已知站点 wab2
broadcast_file = r"edata\attitude_project\rinex2\brdc0030.21n"
# broadcast_file = r"edata\sat_obit\brdc3100.20n"
# 读入观测文件内容,得到类型对象列表
knownStation_ob_records = DoFile.read_Rinex2_oFile(station1_observation_file)
unknownStation_ob_records = DoFile.read_Rinex2_oFile(station2_observation_file)
br_records = DoFile.read_GPS_nFile(broadcast_file)
print("数据读取完毕！")
station1_coor = [-2364336.1554, 4870280.8223, -3360815.9725] # cuaa
# station2_coor = [-2364334.2691, 4870286.6995, -3360808.7896] # cubb
# station2_coor = [-2364334.0912, 4870285.4649, -3360807.7523] # cubb流动站rtk计算结果
# station2_coor = [-2364339.0912, 4870289.4649, -3360809.7523] # cubb错误
# station2_coor = [-2364332.0167, 4870284.0337, -3360814.1380] # cucc
station2_coor = [-2364338.2011, 4870284.7857, -3360809.1387] # cut0
# # station1_coor = [4331300.1600, 567537.0810, 4633133.5100] # zim2
# station2_coor = [4331297.3480, 567555.6390, 4633133.7280] # zimm
# station1_coor = [4327318.2325, 566955.9585, 4636425.9246] # wab2
# RTK2
start_time = datetime.datetime(2021, 1, 3, 6, 5, 0)
end_time = datetime.datetime(2021, 1, 3, 7, 59, 30)
# start_time = datetime.datetime(2020, 11, 5, 8, 40, 0)
# end_time = datetime.datetime(2020, 11, 5, 10, 0, 0)
# station1_observation_file = r"D:\Desktop\XY503_XY602\A503_40.21o" # 已知站点 503
# station2_observation_file = r"D:\Desktop\XY503_XY602\A602_40.21o" # 未知站点 602
# broadcast_file = r"D:\Desktop\XY503_XY602\A602_40.21n"
# knownStation_ob_records = DoFile.read_Rinex3_oFile(station1_observation_file)
# unknownStation_ob_records = DoFile.read_Rinex3_oFile(station2_observation_file)
# br_records = DoFile.read_Renix304_nFile(broadcast_file)
# station1_coor = [-2850420.9626, 4651846.2388, 3292931.3812] # 503
# station2_coor = [-2850405.2169, 4651847.9444, 3292949.6125] # 602
# start_time = datetime.datetime(2021, 2, 9, 10, 0, 0)
# end_time = datetime.datetime(2021, 2, 9, 11, 30, 0)
Tr = start_time
cal_coors = []
DDambiguity_manager = PictureResults.plot_DDambiguity_bysvn()
DDobs_residual_manager = PictureResults.plot_DDobs_residual_bysvn()
prnpoise_manager = PictureResults.plot_obsnoise_bystationsvn()
ele_manager = PictureResults.plot_elevation()
while Tr < end_time:
N_float, residuals, the_SVN, final_SVNs = RTK2.DD_onCPandPR_solve_ambiguity(
knownStation_ob_records, unknownStation_ob_records, br_records, Tr, station1_coor, station2_coor,
bands=['L1_L', 'L2_C'],
DDambiguity_manager=DDambiguity_manager, DDobs_residual_manager=DDobs_residual_manager, prnoise_manager=prnpoise_manager, ele_manager=ele_manager)
print(Tr, N_float, residuals)
Tr += datetime.timedelta(seconds=30)
DDambiguity_manager.plot_DDambiguitys(form="scatter")
DDobs_residual_manager.plot_residuals(form="scatter")
ele_manager.plot_elevations(form='scatter')
# prnpoise_manager.plot_obsnoise()