/**
 * @file    Point2.cpp
 * @brief   2D Point
 * @author  Frank Dellaert
 */

#include "Point2.h"

namespace gtsam {

/* ************************************************************************* */
bool assert_equal(const Point2& p, const Point2& q, double tol) {

  if(fabs(p.x() - q.x()) < tol && fabs(p.y() - q.y()) < tol) return true;
  printf("not equal:\n");
  p.print("p = ");
  q.print("q = ");
  (p-q).print("p-q = ");
  return false;
}

/* ************************************************************************* */

} // namespace gtsam