Austin Schuh | 6b9c415 | 2019-11-29 12:45:24 -0800 | [diff] [blame] | 1 | #include "aos/events/pong_lib.h" |
| 2 | |
Philipp Schrader | 790cb54 | 2023-07-05 21:06:52 -0700 | [diff] [blame] | 3 | #include "glog/logging.h" |
| 4 | |
Austin Schuh | 6b9c415 | 2019-11-29 12:45:24 -0800 | [diff] [blame] | 5 | #include "aos/events/event_loop.h" |
James Kuszmaul | 6f255b2 | 2023-11-06 13:46:54 -0800 | [diff] [blame] | 6 | #include "aos/events/ping_static.h" |
| 7 | #include "aos/events/pong_static.h" |
Austin Schuh | 6b9c415 | 2019-11-29 12:45:24 -0800 | [diff] [blame] | 8 | |
James Kuszmaul | 60bb868 | 2023-08-07 07:39:34 -0700 | [diff] [blame] | 9 | DEFINE_bool(fetch, false, "Poll & fetch messages instead of using a watcher."); |
| 10 | DEFINE_uint32(fetch_period_ms, 10, "Frequency at which to fetch."); |
| 11 | |
Austin Schuh | 6b9c415 | 2019-11-29 12:45:24 -0800 | [diff] [blame] | 12 | namespace aos { |
| 13 | |
| 14 | Pong::Pong(EventLoop *event_loop) |
| 15 | : event_loop_(event_loop), |
James Kuszmaul | 60bb868 | 2023-08-07 07:39:34 -0700 | [diff] [blame] | 16 | fetcher_(event_loop_->MakeFetcher<examples::Ping>("/test")), |
James Kuszmaul | 6f255b2 | 2023-11-06 13:46:54 -0800 | [diff] [blame] | 17 | sender_(event_loop_->MakeSender<examples::PongStatic>("/test")) { |
James Kuszmaul | 60bb868 | 2023-08-07 07:39:34 -0700 | [diff] [blame] | 18 | 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 Schuh | 6b9c415 | 2019-11-29 12:45:24 -0800 | [diff] [blame] | 32 | |
| 33 | event_loop_->SetRuntimeRealtimePriority(5); |
| 34 | } |
| 35 | |
James Kuszmaul | 60bb868 | 2023-08-07 07:39:34 -0700 | [diff] [blame] | 36 | void 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 Kuszmaul | 6f255b2 | 2023-11-06 13:46:54 -0800 | [diff] [blame] | 43 | aos::Sender<examples::PongStatic>::StaticBuilder builder = |
| 44 | sender_.MakeStaticBuilder(); |
James Kuszmaul | dde6563 | 2023-12-07 16:12:26 -0800 | [diff] [blame] | 45 | builder->set_value(ping.value()); |
| 46 | builder->set_initial_send_time(ping.send_time()); |
James Kuszmaul | 6f255b2 | 2023-11-06 13:46:54 -0800 | [diff] [blame] | 47 | builder.CheckOk(builder.Send()); |
James Kuszmaul | 60bb868 | 2023-08-07 07:39:34 -0700 | [diff] [blame] | 48 | } |
| 49 | |
Austin Schuh | 6b9c415 | 2019-11-29 12:45:24 -0800 | [diff] [blame] | 50 | } // namespace aos |