PolygonIterator.hpp

Go to the documentation of this file.

/*
 * PolygonIterator.hpp
 *
 *  Created on: Sep 19, 2014
 *      Author: Péter Fankhauser
 *   Institute: ETH Zurich, ANYbotics
 */

#pragma once

#include "grid_map_core/GridMap.hpp"
#include "grid_map_core/Polygon.hpp"
#include "grid_map_core/iterators/SubmapIterator.hpp"

#include <memory>

namespace grid_map {

class PolygonIterator
{
public:

  PolygonIterator(const grid_map::GridMap& gridMap, const grid_map::Polygon& polygon);

  bool operator !=(const PolygonIterator& other) const;

  const Index& operator *() const;

  PolygonIterator& operator ++();

  bool isPastEnd() const;

private:

  bool isInside() const;

  void findSubmapParameters(const grid_map::Polygon& polygon, Index& startIndex,Size& bufferSize) const;

  grid_map::Polygon polygon_;

  std::shared_ptr<SubmapIterator> internalIterator_;

  Length mapLength_;
  Position mapPosition_;
  double resolution_;
  Size bufferSize_;
  Index bufferStartIndex_;

 public:
  EIGEN_MAKE_ALIGNED_OPERATOR_NEW
};

}  // namespace grid_map