blob: 8fc3f625b81c371dd22264bb49381554e33ae615 [file] [log] [blame]
Austin Schuh6b9c4152019-11-29 12:45:24 -08001#include "aos/events/pong_lib.h"
2
Philipp Schrader790cb542023-07-05 21:06:52 -07003#include "glog/logging.h"
4
Austin Schuh6b9c4152019-11-29 12:45:24 -08005#include "aos/events/event_loop.h"
James Kuszmaul6f255b22023-11-06 13:46:54 -08006#include "aos/events/ping_static.h"
7#include "aos/events/pong_static.h"
Austin Schuh6b9c4152019-11-29 12:45:24 -08008
James Kuszmaul60bb8682023-08-07 07:39:34 -07009DEFINE_bool(fetch, false, "Poll & fetch messages instead of using a watcher.");
10DEFINE_uint32(fetch_period_ms, 10, "Frequency at which to fetch.");
11
Austin Schuh6b9c4152019-11-29 12:45:24 -080012namespace aos {
13
14Pong::Pong(EventLoop *event_loop)
15 : event_loop_(event_loop),
James Kuszmaul60bb8682023-08-07 07:39:34 -070016 fetcher_(event_loop_->MakeFetcher<examples::Ping>("/test")),
James Kuszmaul6f255b22023-11-06 13:46:54 -080017 sender_(event_loop_->MakeSender<examples::PongStatic>("/test")) {
James Kuszmaul60bb8682023-08-07 07:39:34 -070018 if (FLAGS_fetch) {
19 event_loop_
20 ->AddPhasedLoop(
21 [this](int) {
22 while (fetcher_.FetchNext()) {
23 HandlePing(*fetcher_.get());
24 }
25 },
26 std::chrono::milliseconds(FLAGS_fetch_period_ms))
27 ->set_name("pong");
28 } else {
29 event_loop_->MakeWatcher(
30 "/test", [this](const examples::Ping &ping) { HandlePing(ping); });
31 }
Austin Schuh6b9c4152019-11-29 12:45:24 -080032
33 event_loop_->SetRuntimeRealtimePriority(5);
34}
35
James Kuszmaul60bb8682023-08-07 07:39:34 -070036void Pong::HandlePing(const examples::Ping &ping) {
37 if (last_value_ == ping.value() && (!quiet_ || VLOG_IS_ON(1))) {
38 LOG(WARNING) << "Duplicate ping value at " << last_value_
39 << " time difference " << ping.send_time() - last_send_time_;
40 }
41 last_value_ = ping.value();
42 last_send_time_ = ping.send_time();
James Kuszmaul6f255b22023-11-06 13:46:54 -080043 aos::Sender<examples::PongStatic>::StaticBuilder builder =
44 sender_.MakeStaticBuilder();
James Kuszmauldde65632023-12-07 16:12:26 -080045 builder->set_value(ping.value());
46 builder->set_initial_send_time(ping.send_time());
James Kuszmaul6f255b22023-11-06 13:46:54 -080047 builder.CheckOk(builder.Send());
James Kuszmaul60bb8682023-08-07 07:39:34 -070048}
49
Austin Schuh6b9c4152019-11-29 12:45:24 -080050} // namespace aos