| Brian | 3afd6fc | 2014-04-02 20:41:49 -0700 | [diff] [blame] | 1 | #include "aos/common/util/phased_loop.h" |
| brians | 343bc11 | 2013-02-10 01:53:46 +0000 | [diff] [blame] | 2 | |
| brians | 343bc11 | 2013-02-10 01:53:46 +0000 | [diff] [blame] | 3 | namespace aos { |
| 4 | namespace time { |
| 5 | |
| Austin Schuh | 8aec1ed | 2016-05-01 13:29:20 -0700 | [diff] [blame] | 6 | int PhasedLoop::Iterate(const monotonic_clock::time_point now) { |
| 7 | const monotonic_clock::time_point next_time = |
| 8 | monotonic_clock::time_point( |
| 9 | (((now - offset_).time_since_epoch() + monotonic_clock::duration(1)) / |
| 10 | interval_) * |
| 11 | interval_) + |
| 12 | ((now.time_since_epoch() < offset_) ? monotonic_clock::zero() |
| 13 | : interval_) + |
| 14 | offset_; |
| Brian Silverman | dcaa3f7 | 2015-11-29 05:32:08 +0000 | [diff] [blame] | 15 | |
| Austin Schuh | 8aec1ed | 2016-05-01 13:29:20 -0700 | [diff] [blame] | 16 | const monotonic_clock::duration difference = next_time - last_time_; |
| 17 | const int result = difference / interval_; |
| Brian Silverman | dcaa3f7 | 2015-11-29 05:32:08 +0000 | [diff] [blame] | 18 | CHECK_EQ(difference, interval_ * result); |
| Austin Schuh | 8aec1ed | 2016-05-01 13:29:20 -0700 | [diff] [blame] | 19 | CHECK_EQ( |
| 20 | 0, (next_time - offset_).time_since_epoch().count() % interval_.count()); |
| Brian Silverman | dcaa3f7 | 2015-11-29 05:32:08 +0000 | [diff] [blame] | 21 | CHECK_GE(next_time, now); |
| 22 | CHECK_LE(next_time - now, interval_); |
| 23 | last_time_ = next_time; |
| 24 | return result; |
| 25 | } |
| 26 | |
| brians | 343bc11 | 2013-02-10 01:53:46 +0000 | [diff] [blame] | 27 | } // namespace timing |
| 28 | } // namespace aos |