-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathmain_light.jl
102 lines (77 loc) · 2.81 KB
/
main_light.jl
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
92
93
94
95
96
97
98
99
100
101
102
#include("orbit/orbit.jl")
include("external_model/external_model.jl")
#include("dynamic_model/dynamic_model.jl")
#include("dynamics/dynamics.jl")
#include("satellite/satellite.jl")
#include("plot/plot_plots.jl")
include("plot/plot_makie.jl")
include("coordinates.jl")
using SatelliteToolbox
using Dates
using LinearAlgebra
using HDF5
function main()
#=
設定パラメータ
=#
DataNum =100 #シミュレータ反復回数
dt = 5 ##シミュレータの計算間隔 [s]
start_time = DateTime(2019, 12, 19, 3, 27, 10) #シミュレート開始時刻
TLEFileName = "./orbit/ISS_TLE.txt"
# 進行方向とSCOFx軸とのずれ（内積）
dotvs = zeros(DataNum)
# 軌道計算については先に行い、全時間分を配列に保存する
# JD_log, x_ecef_log, v_ecef_log, x_geod_log = orbit_cal(DataNum,dt,start_time,TLEFileName)
JD_log = h5read("./orbit/orbit_data.h5", "JD_log")
x_ecef_log = h5read("./orbit/orbit_data.h5", "x_ecef_log")
v_ecef_log = h5read("./orbit/orbit_data.h5", "v_ecef_log")
x_geod_log = h5read("./orbit/orbit_data.h5", "x_geod_log")
# SCOF上での衛星の進行方向
direct_on_SCOFs = zeros(DataNum,3)
# 衛星外環境モデル用変数
mag_vecs = zeros(DataNum,3)
sun_vecs = zeros(DataNum,3)
atoms_denses = zeros(DataNum)
# 衛星内環境モデル用変数
torqe = zeros(DataNum,3)
# plot_makie
# mp_earth()
for i=1:DataNum
# 時刻表示
current_time = start_time+Second(dt) * i
println("")
println("Current DateTime:",current_time)
println(" JD:",JD_log[i])
println(" x_ecef_log:",x_ecef_log[i,:])
println(" v_ecef_log:",v_ecef_log[i,:])
println(" x_geod_log:",x_geod_log[i,:])
dotv = dot(x_ecef_log[i,:] , v_ecef_log[i,:])
dotvs[i] = dotv
println(" dotv:",dotv)
# 衛星外環境モデル計算
mag_vec, sun_vec, atoms_dens = external_model(current_time,x_ecef_log[i,:],x_geod_log[i,:])
println(" mag_vec:",mag_vec)
mag_vecs[i,:] = mag_vec
println(" sun_vec:",sun_vec)
sun_vecs[i,:] = sun_vec
println(" atoms_dens:",atoms_dens)
atoms_denses[i] = atoms_dens
direct_on_SCOFs[i,:] = ecef_to_DCM(x_ecef_log[i,:],v_ecef_log[i,:],true) * v_ecef_log[i,:]
#mp_sat(my_scene,x_ecef_log[i,:])
sleep(1/24)
end
#plot_2scalar(JD_log,dotvs,"dotvs")
#plot_vec(direct_on_SCOFs,"direct_on_SCOFs")
#
#plot_2scalar(JD_log,atoms_denses,"atoms_dens")
#plot_2scalar(JD_log,x_geod_log[:,3],"height")
#plot_vec(mag_vecs,"mag_vec")
#plot_vec(sun_vecs,"sun_vec")
#plot_vec(x_ecef_log,"x_ecef_log")
#plot_vec(v_ecef_log,"v_ecef_log")
#plot_vec(x_geod_log,"x_geod_log")
#plot_2scalar(x_geod_log[:,2],x_geod_log[:,1],"x_geod_log_2d")
end
my_scene = Scene()
mp_basic_coordinate(my_scene)
main()