FakeOdometry.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_FAKEODOMETRY_H
#define YARP_FAKEODOMETRY_H
 
#include <yarp/os/PeriodicThread.h>
#include <yarp/sig/Vector.h>
#include <yarp/dev/DeviceDriver.h>
#include <yarp/dev/IOdometry2D.h>
 
constexpr double default_period = 0.02;
 
class FakeOdometry :
        public yarp::os::PeriodicThread,
        public yarp::dev::DeviceDriver,
        public yarp::dev::Nav2D::IOdometry2D
{
public:
    FakeOdometry();
 
    // PeriodicThread
    virtual bool threadInit() override;
    virtual void threadRelease() override;
    virtual void run() override;
 
    // DeviceDriver
    bool open(yarp::os::Searchable& config) override;
    bool close() override;
 
    // IOdometry2D
    bool   getOdometry(yarp::dev::OdometryData& odom, double* timestamp=nullptr) override;
    bool   resetOdometry() override;
 
private:
    yarp::dev::OdometryData m_odometryData;
 
    std::mutex m_odometry_mutex;
    double m_period;
    double m_timestamp=0;
};
 
#endif // YARP_FAKEODOMETRY_H