AbsoluteEncoderSensor.hpp

/***************************************************************************

                        AbsoluteEncoderSensor.hpp -  description
                           -------------------
    begin                : Tue Oct 26 2004
    copyright            : (C) 2004 Johan Rutgeerts
    email                : peter.soetens@mech.kuleuven.ac.be

 ***************************************************************************
 *   This library is free software; you can redistribute it and/or         *
 *   modify it under the terms of the GNU Lesser General Public            *
 *   License as published by the Free Software Foundation; either          *
 *   version 2.1 of the License, or (at your option) any later version.    *
 *                                                                         *
 *   This library is distributed in the hope that it will be useful,       *
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU     *
 *   Lesser General Public License for more details.                       *
 *                                                                         *
 *   You should have received a copy of the GNU Lesser General Public      *
 *   License along with this library; if not, write to the Free Software   *
 *   Foundation, Inc., 59 Temple Place,                                    *
 *   Suite 330, Boston, MA  02111-1307  USA                                *
 *                                                                         *
 ***************************************************************************/

#ifndef ABSOLUTE_ENCODER_SENSOR_HPP
#define ABSOLUTE_ENCODER_SENSOR_HPP

#include <ocl/OCL.hpp>
#include <rtt/dev/EncoderInterface.hpp>
#include <rtt/dev/SensorInterface.hpp>
#include <rtt/dev/CalibrationInterface.hpp>

#include <limits>

namespace OCL
{
    class AbsoluteEncoderSensor
        : public SensorInterface<double>
    {
        EncoderInterface* enc;
        double unit_to_inc;
        double min;
        double max;
        double posOffset;
        bool calibrated;

    public:
        AbsoluteEncoderSensor(EncoderInterface* _enc, double _unit_to_inc, int _posOffset, double _minpos, double _maxpos)
            : enc(_enc), unit_to_inc(_unit_to_inc), min(_minpos), max(_maxpos), posOffset(_posOffset / _unit_to_inc), calibrated(true)
        {}

        virtual int readSensor( double& p ) const
        {
            p = readSensor();
            return 0;
        }

        void limit(double _min, double _max)
        {
            min = _min;
            max = _max;
        }

        virtual void calibrate()
        {
            this->calibrated = true;
        }

        virtual void unCalibrate()
        {
            this->calibrated = false;
        }

        virtual bool isCalibrated() const
        {
            return this->calibrated;
        }

        virtual double readSensor() const
        {
            if ( enc->upcounting() )
                return ( enc->turnGet() * enc->resolution() + enc->positionGet() ) / unit_to_inc - posOffset;
            else
                return ( enc->turnGet() * enc->resolution() + ( enc->resolution() - enc->positionGet() ) ) / unit_to_inc - posOffset;
        }

        virtual double maxMeasurement() const
        {
            return max;
        }

        virtual double minMeasurement() const
        {
            return min;
        }

        virtual double zeroMeasurement() const
        {
            return 0.0;
        }
    };
};

#endif

---