Map2DLocation.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_MAP2DLOCATION_H
#define YARP_DEV_MAP2DLOCATION_H
 
#include <sstream>
#include <string>
 
//#include <yarp/math/Vec2D.h>
#include <yarp/dev/api.h>
#include <yarp/dev/NavTypes.h>
#include <yarp/dev/Map2DLocationData.h>
 
namespace yarp::dev::Nav2D {
struct YARP_dev_API Map2DLocation : public Map2DLocationData
{
    Map2DLocation(const std::string& map_name, const double& inX, const double& inY, const double& inT, const std::string& desc = "")
    {
        map_id = map_name;
        x = inX;
        y = inY;
        theta = inT;
        description = desc;
    }
 
    Map2DLocation(const std::string& map_name, const yarp::dev::Nav2D::XYWorld& location, const std::string& desc = "")
    {
        map_id = map_name;
        x = location.x;
        y = location.y;
        theta = 0;
        description = desc;
    }
 
    Map2DLocation()
    {
        map_id = "";
        description = "";
        x = 0;
        y = 0;
        theta = 0;
    }
 
    std::string toString() const
    {
        std::ostringstream stringStream;
        stringStream.precision(-1);
        stringStream.width(-1);
        stringStream << std::string("map_id:") << map_id << std::string(" x:") << x << std::string(" y:") << y << std::string(" theta:") << theta;
        stringStream << std::string("desc:") << description;
        return stringStream.str();
    }
 
    inline bool operator!=(const Map2DLocation& r) const
    {
        if (
            map_id != r.map_id || x != r.x || y != r.y || theta != r.theta) {
            return true;
        }
        return false;
    }
 
    inline bool operator==(const Map2DLocation& r) const
    {
        if (
            map_id == r.map_id && x == r.x && y == r.y && theta == r.theta) {
            return true;
        }
        return false;
    }
 
    bool is_near_to(const Map2DLocation& other_loc, double linear_tolerance, double angular_tolerance) const;
 
    bool read(yarp::os::idl::WireReader& reader) override
    {
        return Map2DLocationData::read(reader);
    }
    bool write(const yarp::os::idl::WireWriter& writer) const override
    {
        return Map2DLocationData::write(writer);
    }
    bool read(yarp::os::ConnectionReader& reader) override
    {
        return Map2DLocationData::read(reader);
    }
    bool write(yarp::os::ConnectionWriter& writer) const override
    {
        return Map2DLocationData::write(writer);
    }
};
} // namespace yarp::dev::Nav2D
 
#endif // YARP_DEV_MAP2DLOCATION_H