coucou

Dependencies:   RoboClaw mbed

Fork of Robot2016_2-0 by ARES

ControlleurPince/ControlleurPince.h

Committer:
Jagang
Date:
2016-05-05
Revision:
71:5590dbe8393a
Parent:
58:02dc8328975a

File content as of revision 71:5590dbe8393a:

#ifndef CONTROLLEUR_PINCE_H
#define CONTROLLEUR_PINCE_H

//#include "defines.h"
#include "Stepper.h"
#include "mbed.h"

class ControlleurPince
{
    
    public:
    
        ControlleurPince(Stepper &p_RMot, Stepper &p_ZMot, Stepper &p_LMot, DigitalIn &p_EnR, DigitalIn &p_EnZ, DigitalIn &p_EnL, AX12 &_Lax12, AX12 &_Rax12);
        
        void init();
        void home(bool r=true, bool z=true, bool l=true);
        void setPos(float z, float delta, float center = -600);
        
        void close();
        void open();
    
    private:
    
        Stepper &RMot, &ZMot, &LMot;
        
        DigitalIn &EnR, &EnZ, &EnL;
        
        AX12 &Lax12, &Rax12;
        
        float pos_r,pos_z,pos_l;
};

#endif