ARES / Mbed 2 deprecated Robot 2015

Robot's source code

Dependencies:   mbed

Asserv_Plan_B/planB.h

Committer:
sype
Date:
2015-04-10
Revision:
70:56086a37f31f
Parent:
68:1ef8b1a37252
Child:
71:95d76c181b22

File content as of revision 70:56086a37f31f:

#include "mbed.h"
#include "Odometry.h"
#include "Motor.h"

class aserv_planB
{
public:
    aserv_planB(Odometry &odometry,Motor &motorL,Motor &motorR);
    void update(float dt);
    void control_speed();
    void control_position();
    float Kp, Ki, Kd;

private:
    Odometry &m_odometry;
    Motor &m_motorL;
    Motor &m_motorR;
    
    float erreur_g, vitesse_g;
    float erreur_d, vitesse_d;
    float cmd_g, cmd_d;
    float consigne_g, consigne_d;
    float somme_erreur_g, somme_erreur_d;
    
    float erreur_position_g, position_g;
    float erreur_position_d, position_d;
    float consigne_position_g, consigne_position_d;

};