LatOdom.hpp

Go to the documentation of this file.

/* Generated from orogen/lib/orogen/templates/tasks/Task.hpp */

#ifndef ODOMETRY_SKIDLATERAL_TASK_HPP
#define ODOMETRY_SKIDLATERAL_TASK_HPP

#include "odometry/LatOdomBase.hpp"
#include <odometry/Odometry.hpp>

namespace odometry{

    class LatOdom : public LatOdomBase
    {
        friend class LatOdomBase;
    protected:

        boost::shared_ptr<odometry::SkidOdometry> odometry;

        /* time_stamp of last measurement */
        base::Time prev_ts;

        base::samples::Joints currentActuatorSample;
        bool actuatorUpdated;
        bool gotSteeringActuatorReading = false;

        
        std::vector<std::string> leftWheelNames;
        std::vector<std::string> rightWheelNames;
        std::vector<std::string> leftSteeringNames;
        std::vector<std::string> rightSteeringNames;
        
        void printInvalidSample();
        double wheelRadius;
        
        virtual void actuator_samplesTransformerCallback(const base::Time &ts, const ::base::samples::Joints &actuator_samples_sample);

    public:
        LatOdom(std::string const& name = "odometry::LatOdom");

        LatOdom(std::string const& name, RTT::ExecutionEngine* engine);

        ~LatOdom();

        bool configureHook();

        bool startHook();

        void updateHook();

        void errorHook();

        void stopHook();

        void cleanupHook();
    };
}

#endif