WrenchSensor.hpp

// Copyright  (C)  2007  Ruben Smits <ruben dot smits at mech dot kuleuven dot be>

// Version: 1.0
// Author: Ruben Smits <ruben dot smits at mech dot kuleuven dot be>
// Maintainer: Ruben Smits <ruben dot smits at mech dot kuleuven dot be>
// URL: http://www.orocos.org/ocl

// This program is free software; you can redistribute it and/or modify
// it under the terms of the GNU General Public License as published by
// the Free Software Foundation; either version 2 of the License, or
// (at your option) any later version.

// This program 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 General Public License for more details.

// You should have received a copy of the GNU General Public License
// along with this program; if not, write to the Free Software
// Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA

#ifndef WRENCH_SENSOR_H
#define WRENCH_SENSOR_H

#include <rtt/TaskContext.hpp>
#include <rtt/Attribute.hpp>
#include <rtt/Event.hpp>
#include <rtt/Method.hpp>
#include <rtt/Command.hpp>
#include <rtt/Ports.hpp>
#include <kdl/frames.hpp>

#include <rtt/RTT.hpp>
#if defined (OROPKG_OS_LXRT)

#include "drivers/jr3_lxrt_common.h"

#else

struct s16Forces
{
    short   Fx, Fy, Fz, Tx, Ty, Tz; // Signed 16 bit
};

#endif

#include <ocl/OCL.hpp>

namespace OCL
{
    class WrenchSensor : public RTT::TaskContext
    {
    public:
        WrenchSensor(std::string name);
        virtual ~WrenchSensor(){};

    protected:
        virtual bool configureHook();
        virtual bool startHook();
        virtual void updateHook();
        virtual void stopHook();
        virtual void cleanupHook(){};

        RTT::DataPort<KDL::Wrench> outdatPort;

        RTT::Event<void(std::string)> maximumLoadEvent;

        RTT::Method<KDL::Wrench(void)> maxMeasurement_mtd;
        RTT::Method<KDL::Wrench(void)> minMeasurement_mtd;
        RTT::Method<KDL::Wrench(void)> zeroMeasurement_mtd;
        RTT::Command<bool(double)> chooseFilter_cmd;
        RTT::Command<bool(KDL::Wrench)> setOffset_cmd;
        RTT::Command<bool(KDL::Wrench)> addOffset_cmd;

        RTT::Property<KDL::Wrench>   offset;
        RTT::Property<unsigned int>  dsp_prop;
        RTT::Property<double>        filter_period_prop;

    private:
        virtual KDL::Wrench maxMeasurement() const;
        virtual KDL::Wrench minMeasurement() const;
        virtual KDL::Wrench zeroMeasurement() const;

        virtual bool chooseFilter(double period);
        virtual bool chooseFilterDone() const;

        virtual bool setOffset(KDL::Wrench in);
        virtual bool addOffset(KDL::Wrench in);
        virtual bool setOffsetDone() const;

        unsigned int  filterToReadFrom;
        unsigned int  dsp;

        KDL::Wrench  writeBuffer;
        s16Forces    write_struct,full_scale;

    };
}//namespace

#endif

---