ARES / Mbed 2 deprecated Robot 2015

Robot's source code

Dependencies:   mbed

Asserv_Plan_B/planB.h@100:a827a645d6c2, 2015-04-30 (annotated)

Committer:
Jagang
Date:
Thu Apr 30 16:16:29 2015 +0000
Revision:
100:a827a645d6c2
Parent:
94:5c37bcf73d14
Parent:
93:4d5664e9188a 
Merge 2;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sype 59:67e0d6ed44b6 1 #include "mbed.h"
Jagang 71:95d76c181b22 2 #include "Odometry2.h"
Jagang 62:454cd844fe1e 3 #include "Motor.h"
sype 59:67e0d6ed44b6 4
Jagang 62:454cd844fe1e 5 class aserv_planB
Jagang 62:454cd844fe1e 6 {
sype 64:6489bcfc1173 7 public:
Jagang 71:95d76c181b22 8 aserv_planB(Odometry2 &odometry,Motor &motorL,Motor &motorR);
Jagang 62:454cd844fe1e 9 void update(float dt);
sype 64:6489bcfc1173 10 void control_speed();
Jagang 71:95d76c181b22 11 void setGoal(float x, float y, float theta);
Jagang 93:4d5664e9188a 12 bool isArrived(void) {return done;}
sype 85:8e95432d99d3 13 float carre(float x) {return x*x;}
sype 85:8e95432d99d3 14 float Kp_angle, Kd_angle;
sype 85:8e95432d99d3 15 float Kp_distance, Ki_distance, Kd_distance;
sype 64:6489bcfc1173 16 private:
Jagang 71:95d76c181b22 17 Odometry2 &m_odometry;
Jagang 62:454cd844fe1e 18 Motor &m_motorL;
Jagang 62:454cd844fe1e 19 Motor &m_motorR;
sype 64:6489bcfc1173 20
sype 64:6489bcfc1173 21 float erreur_g, vitesse_g;
sype 64:6489bcfc1173 22 float erreur_d, vitesse_d;
sype 64:6489bcfc1173 23 float cmd_g, cmd_d;
sype 64:6489bcfc1173 24 float consigne_g, consigne_d;
sype 79:d97090bb6470 25 float somme_erreur, somme_erreur_d;
Near32 94:5c37bcf73d14 26 float delta_erreur;
sype 79:d97090bb6470 27 float erreur_precedente;
Jagang 71:95d76c181b22 28 float m_goalX, m_goalY, m_goalTheta;
sype 79:d97090bb6470 29 bool done;
sype 79:d97090bb6470 30 int N;
Near32 94:5c37bcf73d14 31 float moyenne;
Near32 94:5c37bcf73d14 32 float limite;
Jagang 71:95d76c181b22 33
Jagang 71:95d76c181b22 34 char state;
sype 79:d97090bb6470 35 //char etat_angle;
Jagang 71:95d76c181b22 36
sype 79:d97090bb6470 37 float cmd;
sype 70:56086a37f31f 38 float erreur_position_g, position_g;
sype 70:56086a37f31f 39 float erreur_position_d, position_d;
sype 70:56086a37f31f 40 float consigne_position_g, consigne_position_d;
sype 64:6489bcfc1173 41
Jagang 62:454cd844fe1e 42 };