MapGrid2DInfo.h

Go to the documentation of this file.

/*
 * Copyright (C) 2006-2020 Istituto Italiano di Tecnologia (IIT)
 * All rights reserved.
 *
 * This software may be modified and distributed under the terms of the
 * BSD-3-Clause license. See the accompanying LICENSE file for details.
 */
 
#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
{
    namespace dev
    {
        namespace 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;
            };
        }
    }
}
 
#endif // YARP_DEV_MAPGRID2D_H