void Odometry::init(const ros::Time& time) { // Reset accumulators: linear_x_acc_ = RollingMeanAcc(RollingWindow::window_size = velocity_rolling_window_size_); linear_y_acc_ = RollingMeanAcc(RollingWindow::window_size = velocity_rolling_window_size_); angular_acc_ = RollingMeanAcc(RollingWindow::window_size = velocity_rolling_window_size_); // Reset timestamp: timestamp_ = time; }
void Odometry::resetAccumulators() { linear_acc_ = RollingMeanAcc(RollingWindow::window_size = velocity_rolling_window_size_); angular_acc_ = RollingMeanAcc(RollingWindow::window_size = velocity_rolling_window_size_); }