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
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
|
#include "object_tracker.h"
#include "common/utils.h"
namespace satdump
{
nlohmann::json ObjectTracker::getStatus()
{
nlohmann::json v;
std::string obj_name = "None";
if (tracking_mode == TRACKING_HORIZONS)
obj_name = horizonsoptions[current_horizons_id].second;
else if (tracking_mode == TRACKING_SATELLITE)
obj_name = satoptions[current_satellite_id];
v["object_name"] = obj_name;
v["sat_current_pos"] = sat_current_pos;
if (tracking_mode == TRACKING_SATELLITE && satellite_object != nullptr)
{
v["sat_azimuth_rate"] = satellite_observation_pos.azimuth_rate * RAD_TO_DEG;
v["sat_elevation_rate"] = satellite_observation_pos.elevation_rate * RAD_TO_DEG;
v["sat_current_range"] = satellite_observation_pos.range;
}
v["next_aos_time"] = next_aos_time;
v["next_los_time"] = next_los_time;
double timeOffset = 0, ctime = getTime();
if (next_aos_time > ctime)
timeOffset = next_aos_time - ctime;
else
timeOffset = next_los_time - ctime;
v["next_event_in"] = timeOffset;
v["next_event_is_aos"] = next_aos_time > ctime;
v["rotator_engaged"] = rotator_engaged;
v["rotator_tracking"] = rotator_tracking;
v["rot_current_pos"] = rot_current_pos;
v["rot_current_req_pos"] = rot_current_req_pos;
return v;
}
image::Image ObjectTracker::getPolarPlotImg(int plot_size)
{
image::Image img(8, plot_size, plot_size, 3);
// All black bg
img.fill(0);
// Draw the "target-like" plot with elevation rings
float radius = 0.45;
float radius1 = plot_size * radius * (3.0 / 9.0);
float radius2 = plot_size * radius * (6.0 / 9.0);
float radius3 = plot_size * radius * (9.0 / 9.0);
std::vector<double> color_green = {0, 1, 0};
std::vector<double> color_red = {1, 0, 0};
std::vector<double> color_orange = {1, 165.0 / 255.0, 0};
std::vector<double> color_cyan = {0, 237.0 / 255.0, 1};
img.draw_circle(plot_size / 2, plot_size / 2,
radius1, color_green, false);
img.draw_circle(plot_size / 2, plot_size / 2,
radius2, color_green, false);
img.draw_circle(plot_size / 2, plot_size / 2,
radius3, color_green, false);
img.draw_line(plot_size / 2, 0,
plot_size / 2, plot_size - 1,
color_green);
img.draw_line(0, plot_size / 2,
plot_size - 1, plot_size / 2,
color_green);
// Draw the satellite's trace
if (upcoming_pass_points.size() > 1)
{
upcoming_passes_mtx.lock();
for (int i = 0; i < (int)upcoming_pass_points.size() - 1; i++)
{
auto &p1 = upcoming_pass_points[i];
auto &p2 = upcoming_pass_points[i + 1];
float point_x1, point_x2, point_y1, point_y2;
point_x1 = point_x2 = plot_size / 2;
point_y1 = point_y2 = plot_size / 2;
point_x1 += az_el_to_plot_x(plot_size, radius, p1.az, p1.el);
point_y1 -= az_el_to_plot_y(plot_size, radius, p1.az, p1.el);
point_x2 += az_el_to_plot_x(plot_size, radius, p2.az, p2.el);
point_y2 -= az_el_to_plot_y(plot_size, radius, p2.az, p2.el);
img.draw_line(point_x1, point_y1,
point_x2, point_y2,
color_orange);
}
upcoming_passes_mtx.unlock();
}
// Draw the current satellite position
if (sat_current_pos.el > 0)
{
float point_x = plot_size / 2;
float point_y = plot_size / 2;
point_x += az_el_to_plot_x(plot_size, radius, sat_current_pos.az, sat_current_pos.el);
point_y -= az_el_to_plot_y(plot_size, radius, sat_current_pos.az, sat_current_pos.el);
img.draw_circle(point_x, point_y, 5, color_red, true);
}
if (rotator_handler && rotator_handler->is_connected())
{
{
float point_x = plot_size / 2;
float point_y = plot_size / 2;
point_x += az_el_to_plot_x(plot_size, radius, rot_current_pos.az, rot_current_pos.el);
point_y -= az_el_to_plot_y(plot_size, radius, rot_current_pos.az, rot_current_pos.el);
img.draw_circle(point_x, point_y, 9, color_cyan, false);
}
if (rotator_engaged)
{
float point_x = plot_size / 2;
float point_y = plot_size / 2;
point_x += az_el_to_plot_x(plot_size, radius, rot_current_req_pos.az, rot_current_req_pos.el);
point_y -= az_el_to_plot_y(plot_size, radius, rot_current_req_pos.az, rot_current_req_pos.el);
img.draw_line(point_x - 5, point_y, point_x - 12, point_y, color_cyan);
img.draw_line(point_x + 5, point_y, point_x + 12, point_y, color_cyan);
img.draw_line(point_x, point_y - 5, point_x, point_y - 12, color_cyan);
img.draw_line(point_x, point_y + 5, point_x, point_y + 12, color_cyan);
}
}
return img;
}
}
|
