JaiaBot 3.0.0
JaiaBot micro-AUV software
Loading...
Searching...
No Matches
liaison_jaiabot.h
Go to the documentation of this file.
1#ifndef LIAISON_JAIABOT_H
2#define LIAISON_JAIABOT_H
3
4#include <Wt/WAbstractItemModel.h>
5#include <Wt/WEvent.h>
6#include <Wt/WPushButton.h>
7#include <Wt/WSlider.h>
8#include <boost/thread/mutex.hpp>
9#include <boost/units/io.hpp>
10#include <chrono>
11
12#include "goby/zeromq/liaison/liaison_container.h"
13#include <goby/middleware/frontseat/groups.h>
14#include <goby/middleware/gpsd/groups.h>
15#include <goby/middleware/protobuf/frontseat_data.pb.h>
16#include <goby/middleware/protobuf/gpsd.pb.h>
17
18#include "jaiabot/groups.h"
21#include "jaiabot/messages/sensor/salinity.pb.h"
22
23#include "config.pb.h"
24#include "jaiabot/messages/feather.pb.h"
25#include "jaiabot/messages/sensor/pressure_temperature.pb.h"
26#include <Wt/Chart/WCartesianChart.h>
27#include <Wt/WAbstractItemModel.h>
28#include <goby/time/system_clock.h>
29
30namespace jaiabot
31{
32class CommsThread;
33
34class LiaisonJaiabot : public goby::zeromq::LiaisonContainerWithComms<LiaisonJaiabot, CommsThread>
35{
36 public:
37 LiaisonJaiabot(const goby::apps::zeromq::protobuf::LiaisonConfig& cfg,
38 Wt::WContainerWidget* parent = 0);
39
41 void post_node_status(const goby::middleware::frontseat::protobuf::NodeStatus& node_status);
42 void post_tpv(const goby::middleware::protobuf::gpsd::TimePositionVelocity& tpv);
47
48 private:
49 void loop();
50 void focus() override { timer_.start(); }
51 void unfocus() override { timer_.stop(); }
52
53 void vehicle_select(Wt::WString msg);
54 void data_select(Wt::WString msg);
55 void check_add_vehicle(int node_id);
56 void add_data_point(const std::string data_type, double data_point);
57 void key_press(Wt::WKeyEvent key);
58 void key_release(Wt::WKeyEvent key);
59 Wt::WDateTime get_date_time(goby::time::MicroTime mp);
60
61 struct YAxisConfig
62 {
63 std::string title;
64 std::pair<double, double> range;
65 };
66
67 void add_data_type(std::pair<std::string, YAxisConfig>& data_type);
68
69 private:
70 Wt::WComboBox* vehicle_combo_;
71 Wt::WComboBox* data_combo_;
72 Wt::WStackedWidget* vehicle_stack_;
73 Wt::WStackedWidget* data_stack_;
74 Wt::WGroupBox* chart_box;
75
76 struct ChartData
77 {
78 std::map<goby::time::MicroTime, double> data_points;
79 std::string chart_type;
80 YAxisConfig y_axis_config;
81 };
82
83 std::vector<ChartData> chart_data_;
84 std::shared_ptr<Wt::WAbstractItemModel> chart_model_;
85 Wt::Chart::WCartesianChart* chart_ = nullptr;
86
87 // Contains all data types that can be displayed on the chart, along with their Y-axis configurations
88 // Y-axis configurations include the title and range for each data type
89 const std::vector<std::pair<std::string, YAxisConfig>> data_types_ = {
90 {"Pressure", {"Pressure (kPa)", {0, 100}}},
91 {"Salinity", {"Salinity (ppt)", {0, 50}}},
92 {"Temperature", {"Temperature (°C)", {10, 20}}},
93 };
94
95 struct VehicleData
96 {
97 VehicleData(Wt::WStackedWidget*, const protobuf::JaiabotConfig&);
98 VehicleData(const VehicleData&) = delete;
99 VehicleData& operator=(const VehicleData&) = delete;
100
101 std::unique_ptr<Wt::WContainerWidget> vehicle_div;
102
103 struct Controls
104 {
105 Controls(Wt::WContainerWidget* vehicle_div, const protobuf::JaiabotConfig& cfg);
106 Controls(const Controls&) = delete;
107 Controls& operator=(const Controls&) = delete;
108
109 Wt::WSlider* timeout_slider{0};
110 Wt::WText* timeout_text{0};
111 Wt::WSlider* dive_slider{0};
112 Wt::WText* dive_text{0};
113 Wt::WSlider* motor_slider{0};
114 Wt::WText* motor_text{0};
115 Wt::WSlider* port_elevator_slider{0};
116 Wt::WSlider* rudder_slider{0};
117
118 Wt::WSlider* stbd_elevator_slider{0};
119 Wt::WText* fins_text{0};
120 Wt::WText* ack_text{0};
121
123
124 // must be static, not sure why (segfault in JSignal otherwise)
125 static void timeout_slider_moved(int value, Wt::WText* text)
126 {
127 std::cout << "slider moved: " << text << std::endl;
128
129 text->setText(timeout_text_from_value(value));
130 }
131
132 static void dive_slider_moved(int value, Wt::WText* text)
133 {
134 text->setText(dive_text_from_value(value));
135 }
136
137 static void dive_button_clicked() { dive_start_ = true; }
138
139 static void motor_slider_moved(int value, Wt::WText* text)
140 {
141 text->setText(motor_text_from_value(value));
142 }
143
144 static void port_elevator_slider_moved(int value, Wt::WText* text,
145 Wt::WSlider* stbd_elevator, Wt::WSlider* rudder)
146 {
147 text->setText(fins_text_from_value(value, stbd_elevator->value(), rudder->value()));
148 }
149
150 static void stbd_elevator_slider_moved(int value, Wt::WText* text,
151 Wt::WSlider* port_elevator, Wt::WSlider* rudder)
152 {
153 text->setText(fins_text_from_value(port_elevator->value(), value, rudder->value()));
154 }
155 static void rudder_slider_moved(int value, Wt::WText* text, Wt::WSlider* port_elevator,
156 Wt::WSlider* stbd_elevator)
157 {
158 text->setText(
159 fins_text_from_value(port_elevator->value(), stbd_elevator->value(), value));
160 }
161
163 {
164 port_elevator_slider->setValue(value);
165 fins_text->setText(fins_text_from_value(port_elevator_slider->value(),
166 stbd_elevator_slider->value(),
167 rudder_slider->value()));
168 }
169
171 {
172 stbd_elevator_slider->setValue(value);
173 fins_text->setText(fins_text_from_value(port_elevator_slider->value(),
174 stbd_elevator_slider->value(),
175 rudder_slider->value()));
176 }
177
178 void set_rudder_value(int value)
179 {
180 rudder_slider->setValue(value);
181 fins_text->setText(fins_text_from_value(port_elevator_slider->value(),
182 stbd_elevator_slider->value(),
183 rudder_slider->value()));
184 }
185
186 void set_motor_value(int value)
187 {
188 motor_slider->setValue(value);
189 motor_text->setText(motor_text_from_value(motor_slider->value()));
190 }
191
192 void set_timeout_value(int value)
193 {
194 timeout_slider->setValue(value);
195 timeout_text->setText(timeout_text_from_value(timeout_slider->value()));
196 }
197
198 void set_dive_value(int value)
199 {
200 dive_slider->setValue(value);
201 dive_text->setText(dive_text_from_value(dive_slider->value()));
202 }
203 };
204
205 Controls low_level_control;
206
207 int index_in_stack{0};
208
209 static std::string timeout_text_from_value(int value)
210 {
211 return "Timeout (X-/V+): " + std::to_string(value);
212 }
213
214 static std::string dive_text_from_value(int value)
215 {
216 return "Dive (Y-/U+): " + std::to_string(value);
217 }
218
219 static std::string motor_text_from_value(int value)
220 {
221 return "Motor (W-/R+): " + std::to_string(value);
222 }
223 static std::string fins_text_from_value(int port_elevator_value, int stbd_elevator_value,
224 int rudder_value)
225 {
226 return "Port Elevator (A-/Q+ or D-/E+ for both): " +
227 std::to_string(port_elevator_value) +
228 "<br/>Starboard Elevator (G-/T+ or D-/E+ for both): " +
229 std::to_string(stbd_elevator_value) +
230 "<br/>Rudder (S-/F+): " + std::to_string(rudder_value);
231 }
232 };
233
234 // vehicle id to Data
235 std::map<int, std::unique_ptr<VehicleData>> vehicle_data_;
236
237 // convenient info shown on vehicle's liaison
238 Wt::WText* bot_node_status_text_;
239 Wt::WText* bot_tpv_text_;
240 Wt::WText* bot_pt_text_;
241 Wt::WText* bot_salinity_text_;
242 Wt::WText* bot_imu_text_;
243 Wt::WText* bot_low_control_text_;
244
245 // currently shown vehicle id
246 int current_vehicle_{-1};
247
248 // currently shown data_type
249 std::string current_data_type_{""};
250
251 bool motor_go_{false};
252 static bool dive_start_;
253 static std::chrono::system_clock::time_point dive_expire_;
254
255 Wt::WTimer timer_;
256 friend class CommsThread;
257 const protobuf::JaiabotConfig& cfg_;
258};
259
260class CommsThread : public goby::zeromq::LiaisonCommsThread<LiaisonJaiabot>
261{
262 public:
263 CommsThread(LiaisonJaiabot* tab, const goby::apps::zeromq::protobuf::LiaisonConfig& config,
264 int index)
265 : LiaisonCommsThread<LiaisonJaiabot>(tab, config, index), tab_(tab)
266 {
267 interprocess().subscribe<groups::control_ack>(
268 [this](const protobuf::LowControlAck& ack)
269 { tab_->post_to_wt([=]() { tab_->post_control_ack(ack); }); });
270
271 // post the NodeStatus message in its own box
272 interprocess().subscribe<goby::middleware::frontseat::groups::node_status>(
273 [this](const goby::middleware::frontseat::protobuf::NodeStatus& node_status)
274 { tab_->post_to_wt([=]() { tab_->post_node_status(node_status); }); });
275
276 // post the tpv in its own box
277 interprocess().subscribe<goby::middleware::groups::gpsd::tpv>(
278 [this](const goby::middleware::protobuf::gpsd::TimePositionVelocity& tpv)
279 { tab_->post_to_wt([=]() { tab_->post_tpv(tpv); }); });
280
281 // post the pt data in its own box
282 interprocess().subscribe<groups::pressure_temperature>(
284 { tab_->post_to_wt([=]() { tab_->post_pt(pt); }); });
285
286 // post the salinity data in its own box
287 interprocess().subscribe<groups::salinity>(
288 [this](const jaiabot::protobuf::SalinityData& salinity)
289 { tab_->post_to_wt([=]() { tab_->post_salinity(salinity); }); });
290
291 // post the imu data in its own box
292 interprocess().subscribe<groups::imu>(
293 [this](const jaiabot::protobuf::IMUData& imu)
294 { tab_->post_to_wt([=]() { tab_->post_imu(imu); }); });
295
296 // post the control surfaces data in its own box
297 interprocess().subscribe<groups::low_control>(
298 [this](const jaiabot::protobuf::LowControl& low_control)
299 { tab_->post_to_wt([=]() { tab_->post_low_control(low_control); }); });
300
301 } // namespace jaiabot
303
304 private:
305 friend class LiaisonJaiabot;
306 LiaisonJaiabot* tab_;
307};
308
309} // namespace jaiabot
310
311#endif
friend class LiaisonJaiabot
CommsThread(LiaisonJaiabot *tab, const goby::apps::zeromq::protobuf::LiaisonConfig &config, int index)
void post_imu(const jaiabot::protobuf::IMUData &imu)
void post_control_ack(const protobuf::LowControlAck &ack)
void post_tpv(const goby::middleware::protobuf::gpsd::TimePositionVelocity &tpv)
void post_low_control(const jaiabot::protobuf::LowControl &low_control)
LiaisonJaiabot(const goby::apps::zeromq::protobuf::LiaisonConfig &cfg, Wt::WContainerWidget *parent=0)
void post_pt(const jaiabot::protobuf::PressureTemperatureData &pt)
void post_node_status(const goby::middleware::frontseat::protobuf::NodeStatus &node_status)
void post_salinity(const jaiabot::protobuf::SalinityData &salinity)
constexpr goby::middleware::Group imu
Definition groups.h:40
constexpr goby::middleware::Group pressure_temperature
Definition groups.h:41
constexpr goby::middleware::Group low_control
Definition groups.h:68
constexpr goby::middleware::Group salinity
Definition groups.h:45
constexpr goby::middleware::Group control_ack
Definition groups.h:69
static void dive_slider_moved(int value, Wt::WText *text)
static void timeout_slider_moved(int value, Wt::WText *text)
static void rudder_slider_moved(int value, Wt::WText *text, Wt::WSlider *port_elevator, Wt::WSlider *stbd_elevator)
Controls & operator=(const Controls &)=delete
Controls(Wt::WContainerWidget *vehicle_div, const protobuf::JaiabotConfig &cfg)
static void stbd_elevator_slider_moved(int value, Wt::WText *text, Wt::WSlider *port_elevator, Wt::WSlider *rudder)
static void port_elevator_slider_moved(int value, Wt::WText *text, Wt::WSlider *stbd_elevator, Wt::WSlider *rudder)
static void motor_slider_moved(int value, Wt::WText *text)