MapClasses.hpp

Go to the documentation of this file.

#ifndef MAP_CLASSES_HPP
#define MAP_CLASSES_HPP
 
#include <galaxis/linatypes.hpp>
 
#include <vector>
#include <map>
#include <mutex>
 
namespace galaxis { namespace map {
  namespace data {
 
    template <typename T>
    class LinePoints {
    private:
      // Both Maps contain same information but in different representations therefore must be consistent
      std::map<T, std::vector<T>> m_pointsXY;
      std::map<T, std::vector<T>> m_pointsYX;
 
      std::mutex m_mtx;
 
    public:
      LinePoints(){};
 
      void clear() {
        m_mtx.lock();
 
        m_pointsXY.clear();
        m_pointsYX.clear();
 
        m_mtx.unlock();
      }
 
      void insert(T x, T y) {
        m_mtx.lock();
 
        auto itX = m_pointsXY.find(x);
        if(itX == m_pointsXY.end()) {
          // insert new vector
          m_pointsXY.insert(std::pair<T, std::vector<T>>(x, std::vector<T>{ y }));
        } else {
          itX->second.push_back(y);
        }
 
        auto itY = m_pointsYX.find(y);
        if(itY == m_pointsYX.end()) {
          // insert new vector
          m_pointsYX.insert(std::pair<T, std::vector<T>>(y, std::vector<T>{ x }));
        }
        else {
          itY->second.push_back(x);
        }
 
        m_mtx.unlock();
      }
 
      std::map<T, std::vector<T>>& getPointsXY() {
        return m_pointsXY;
      }
      std::map<T, std::vector<T>>& getPointsYX() {
        return m_pointsYX;
      }
    };
 
    template <typename T>
    class LinesObject {
    public:
      LinePoints<T> leftLine;
      LinePoints<T> centerLine;
      LinePoints<T> rightLine;
 
      Eigen::Rotation2Df rotationMatrix;
      Eigen::Rotation2Df reverseRotationMatrix;
 
      LinesObject() {}
 
      void clear() {
        leftLine.clear();
        centerLine.clear();
        rightLine.clear();
      }
    };
 
  } // namespace classes
} // namespace map
} // namespace galaxis
#endif