MapGrid2DInfo.h

Go to the documentation of this file.

/*
 * SPDX-FileCopyrightText: 2006-2021 Istituto Italiano di Tecnologia (IIT)
 * SPDX-License-Identifier: BSD-3-Clause
 */
 
#ifndef YARP_DEV_MAPGRID2DINFO_H
#define YARP_DEV_MAPGRID2DINFO_H
 
#include <string>
 
#include <yarp/os/Portable.h>
#include <yarp/os/ConnectionReader.h>
#include <yarp/sig/Image.h>
#include <yarp/math/Vec2D.h>
#include <yarp/dev/api.h>
#include <yarp/dev/Map2DLocation.h>
#include <yarp/dev/NavTypes.h>
 
namespace yarp::dev::Nav2D {
class YARP_dev_API MapGrid2DOrigin
{
private:
    double sa;
    double ca;
 
private:
    double x;     
    double y;     
    double theta; 
public:
    MapGrid2DOrigin();
    MapGrid2DOrigin(double x_init, double y_init, double t_init);
    inline double get_x() const
    {
        return x;
    }
    inline double get_y() const
    {
        return y;
    }
    inline double get_theta() const
    {
        return theta;
    }
    void setOrigin(double x_init, double y_init, double t_init);
    bool operator!=(const MapGrid2DOrigin& other) const;
 
public:
    inline double get_ca() const
    {
        return ca;
    }
    inline double get_sa() const
    {
        return sa;
    }
};
 
class YARP_dev_API MapGrid2DInfo
{
public:
    MapGrid2DInfo();
 
    YARP_SUPPRESS_DLL_INTERFACE_WARNING_ARG(std::string) m_map_name;
    double          m_resolution;   
    MapGrid2DOrigin m_origin;       
    size_t          m_width;        
    size_t          m_height;       
 
    //------------------------------utility functions-------------------------------
    //convert a cell (from the upper-left corner) to the map reference frame (located in m_origin, measured in meters)
    XYWorld cell2World(XYCell cell) const;
    yarp::dev::Nav2D::Map2DLocation toLocation(XYCell cell) const;
    XYCell toXYCell(yarp::dev::Nav2D::Map2DLocation loc) const;
 
    //convert a world location (wrt the map reference frame located in m_origin, measured in meters), to a cell from the upper-left corner.
    XYCell world2Cell(XYWorld world) const;
    XYCell world2Cell_unsafeFast(XYWorld world) const;
    yarp::dev::Nav2D::Map2DLocation toLocation(XYWorld cell) const;
    XYWorld toXYWorld(yarp::dev::Nav2D::Map2DLocation loc) const;
 
    bool   isInsideMap(XYCell cell) const;
 
    bool   isInsideMap(XYWorld world) const;
};
} // namespace yarp::dev::Nav2D
 
#endif // YARP_DEV_MAPGRID2D_H