return sqrt(pow(p.x() - this->x_, 2.0) + pow(p.y() - this->y_, 2.0));
}
+bool
+Point::operator==(Point const& p)
+{
+ return this->x() == p.x() && this->y() == p.y();
+}
+
std::ostream&
operator<<(std::ostream& out, Point const& p)
{
this->h(this->h() + 2.0 * dh);
}
+bool
+Pose::operator==(Pose const& p)
+{
+ return this->x() == p.x() && this->y() == p.y() && this->h() == p.h();
+}
+
std::ostream&
operator<<(std::ostream& out, Pose const& p)
{