50 tol_ = goal.tolerance;
56 ROS_DEBUG(
"Configuring MonocamSettler with tolerance of [%.3f]",
tol_);
64 calibration_msgs::Interval& interval)
68 ROS_WARN(
"Not configured. Going to skip");
86 std::vector<double> tol_vec(deflated->channels_.size(),
tol_);
96 deflated.
header.stamp = msg->header.stamp;
98 const unsigned int N = msg->image_points.size();
100 for (
unsigned int i=0; i<
N; i++)
102 deflated.
channels_[2*i+0] = msg->image_points[i].x;
103 deflated.
channels_[2*i+1] = msg->image_points[i].y;
bool add(const calibration_msgs::CalibrationPatternConstPtr msg, calibration_msgs::Interval &interval)
calibration_msgs::CalibrationPatternConstPtr msg_
static const unsigned int N
void setMaxSize(unsigned int max_size)
void deflate(const calibration_msgs::CalibrationPatternConstPtr &image_features, DeflatedCalibrationPattern &deflated)
bool configure(const monocam_settler::ConfigGoal &goal)
std::vector< double > channels_
static calibration_msgs::Interval computeLatestInterval(const SortedDeque< DeflatedConstPtr > &signal, const std::vector< double > &tolerances, ros::Duration max_spacing)