GLine2D.h

Go to the documentation of this file.

#ifndef GLINE2D_H
#define GLINE2D_H

#include <cmath>
#include <utility>
#include <vector>

#include "MathUtil.h"
#include "XYWeight.h"

namespace AprilTags {

class GLine2D {
public:

  GLine2D();

  /*  @param slope the slope
   *  @param b the y intercept
   */
  GLine2D(float slope, float b);

  /*  @param dx A change in X corresponding to dy
   *  @param dy A change in Y corresponding to dx
   *  @param p A point that the line passes through
   */
  GLine2D(float dX, float dY, const std::pair<float,float>& pt);

  /*  @param p1 the first point
   *  @param p2 the second point
   */
  GLine2D(const std::pair<float,float>& p1, const std::pair<float,float>& p2);

  /*  This allows easy computation if one point is between two other points on the line:
   *  compute the line coordinate of all three points and test if a<=b<=c. This is 
   *  implemented by computing the dot product of the vector 'p' with the
   *  line's direct unit vector.
   */
  float getLineCoordinate(const std::pair<float,float>& p);
  
  std::pair<float,float> getPointOfCoordinate(float coord);

  std::pair<float,float> intersectionWith(const GLine2D& line) const;

  static GLine2D lsqFitXYW(const std::vector<XYWeight>& xyweights);

  inline float getDx() const { return dx; }
  inline float getDy() const { return dy; }
  inline float getFirst() const { return p.first; }
  inline float getSecond() const { return p.second; }

protected:
  void normalizeSlope();
  void normalizeP();

private:
  float dx, dy;
  std::pair<float,float> p;  
  bool didNormalizeSlope;
  bool didNormalizeP;
};

} // namespace

#endif