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;
}
示例#2
0
 void Odometry::resetAccumulators()
 {
   linear_acc_ = RollingMeanAcc(RollingWindow::window_size = velocity_rolling_window_size_);
   angular_acc_ = RollingMeanAcc(RollingWindow::window_size = velocity_rolling_window_size_);
 }