Kuka361nAxesVelocityController.hpp

#ifndef KUKA361_NAXES_VELOCITY_CONTROLLER_HPP
#define KUKA361_NAXES_VELOCITY_CONTROLLER_HPP

#include <vector>
#include <rtt/RTT.hpp>

#include <rtt/TaskContext.hpp>
#include <rtt/Ports.hpp>
#include <rtt/Event.hpp>
#include <rtt/Properties.hpp>
#include <rtt/Command.hpp>


#if defined (OROPKG_OS_LXRT)
#include <rtt/dev/AnalogOutput.hpp>
#include <rtt/dev/DigitalOutput.hpp>

#include "dev/SwitchDigitalInapci1032.hpp"
#include "dev/RelayCardapci2200.hpp"
#include "dev/EncoderSSIapci1710.hpp"
#include "dev/ComediDevice.hpp"
#include "dev/ComediSubDeviceAOut.hpp"

#include "dev/AbsoluteEncoderSensor.hpp"
#include "dev/AnalogDrive.hpp"
#include "dev/Axis.hpp"
#endif
#include "dev/SimulationAxis.hpp"
#include <rtt/dev/AxisInterface.hpp>

#include <ocl/OCL.hpp>
#include <ocl/VectorTemplateComposition.hpp>

#include <kdl/chain.hpp>

namespace OCL
{
    class Kuka361nAxesVelocityController : public TaskContext
    {
    public:
        Kuka361nAxesVelocityController(std::string name);
        virtual ~Kuka361nAxesVelocityController();

    protected:
        Method<bool(void)> startAllAxes_mtd;

        Method<bool(void)> stopAllAxes_mtd;

        Method<bool(void)> unlockAllAxes_mtd;

        Method<bool(void)> lockAllAxes_mtd;

        Command<bool(void)> prepareForUse_cmd;

        Command<bool(void)> prepareForShutdown_cmd;

        Method<bool(std::vector<double>)> addDriveOffset_mtd;

        DataPort<std::vector<double> > driveValues_port;

        DataPort<std::vector<double> >  positionValues_port;

        Property<std::vector <double> > driveLimits_prop;

        Property<std::vector <double> > lowerPositionLimits_prop;

        Property<std::vector <double> > upperPositionLimits_prop;

        Property<std::vector <double> > initialPosition_prop;

        Property<std::vector <double> > driveOffset_prop;

        Property<bool > simulation_prop;
        bool            simulation;

        Property<bool > geometric_prop;

        Property<std::vector<std::string> > EmergencyEvents_prop;

        Constant<unsigned int> num_axes_attr;

        Attribute<KDL::Chain> chain_attr;
        KDL::Chain kinematics;

        Event< void(std::string) > driveOutOfRange_evt;

        Event< void(std::string) > positionOutOfRange_evt;



    private:

        virtual bool startAllAxes();
        virtual bool stopAllAxes();
        virtual bool lockAllAxes();
        virtual bool unlockAllAxes();
        virtual bool addDriveOffset(const std::vector<double>& offset);
        virtual bool prepareForUse();
        virtual bool prepareForUseCompleted() const;
        virtual bool prepareForShutdown();
        virtual bool prepareForShutdownCompleted() const;

        void EmergencyStop(std::string message)
        {
            log(Error) << "---------------------------------------------" << endlog();
            log(Error) << "--------- EMERGENCY STOP --------------------" << endlog();
            log(Error) << "---------------------------------------------" << endlog();
            log(Error) << message << endlog();
            this->fatal();
        };
        std::vector<RTT::Handle> EmergencyEventHandlers;

        bool activated;

        std::vector<double> positionConvertFactor;


        std::vector<double> driveConvertFactor;


        std::vector<double> positionValues, driveValues,
            positionValues_kin,driveValues_rob;

    public:

        virtual bool configureHook();
        virtual bool startHook();
        virtual void updateHook();
        virtual void stopHook();
        virtual void cleanupHook();

        KDL::Chain getKinematics(){
            return kinematics;
        };

    private:

        void convertGeometric();

        //
        // Members implementing the interface to the hardware
        //
#if  (defined (OROPKG_OS_LXRT))
        std::vector<Axis*>  axes_hardware;

        ComediDevice*                    comediDev;
        ComediSubDeviceAOut*             comediSubdevAOut;
        EncoderSSI_apci1710_board*       apci1710;
        RelayCardapci2200*               apci2200;
        SwitchDigitalInapci1032*         apci1032;

        std::vector<EncoderInterface*>           encoderInterface;
        std::vector<AbsoluteEncoderSensor*>      encoder;
        std::vector<AnalogOutput*> vref;
        std::vector<DigitalOutput*>              enable;
        std::vector<AnalogDrive*>                drive;
        std::vector<DigitalOutput*>              brake;

#endif
        std::vector<AxisInterface*>      axes;

    };//class Kuka361nAxesVelocityController

}//namespace Orocos
#endif // KUKA361NAXESVELOCITYCONTROLLER

---