Reception des données du PAMI, diminution des gains d'asservissement
This commit is contained in:
parent
71ccb57220
commit
bda33196ec
@ -2,8 +2,8 @@
|
|||||||
#include "Moteurs.h"
|
#include "Moteurs.h"
|
||||||
#include "Asser_Moteurs.h"
|
#include "Asser_Moteurs.h"
|
||||||
|
|
||||||
#define ASSERMOTEUR_GAIN_P 300000.f
|
#define ASSERMOTEUR_GAIN_P 30000.f
|
||||||
#define ASSERMOTEUR_GAIN_I 30000.f
|
#define ASSERMOTEUR_GAIN_I 3000.f
|
||||||
|
|
||||||
float consigne_mm_s[3]; // Consigne de vitesse (en mm/s)
|
float consigne_mm_s[3]; // Consigne de vitesse (en mm/s)
|
||||||
float commande_I[3]; // Terme integral
|
float commande_I[3]; // Terme integral
|
||||||
|
|||||||
@ -2,8 +2,8 @@
|
|||||||
#include "Commande_vitesse.h"
|
#include "Commande_vitesse.h"
|
||||||
#include "math.h"
|
#include "math.h"
|
||||||
|
|
||||||
#define GAIN_P_POSITION 15
|
#define GAIN_P_POSITION 5
|
||||||
#define GAIN_P_ORIENTATION 10
|
#define GAIN_P_ORIENTATION 5
|
||||||
|
|
||||||
#define MAX_ERREUR_ANGLE (30 * DEGRE_EN_RADIAN)
|
#define MAX_ERREUR_ANGLE (30 * DEGRE_EN_RADIAN)
|
||||||
|
|
||||||
|
|||||||
6
main.c
6
main.c
@ -199,7 +199,7 @@ void main(void)
|
|||||||
msg_trajectoire.trajectoire.p4.x, msg_trajectoire.trajectoire.p4.y);
|
msg_trajectoire.trajectoire.p4.x, msg_trajectoire.trajectoire.p4.y);
|
||||||
trajectoire = msg_trajectoire.trajectoire;
|
trajectoire = msg_trajectoire.trajectoire;
|
||||||
mode = 4;
|
mode = 4;
|
||||||
Trajet_config(100, 100);
|
Trajet_config(200, 100);
|
||||||
|
|
||||||
// Oh la la !
|
// Oh la la !
|
||||||
}
|
}
|
||||||
@ -212,10 +212,10 @@ void main(void)
|
|||||||
registre = message.donnees[2];
|
registre = message.donnees[2];
|
||||||
if(id_carte == 'D'){
|
if(id_carte == 'D'){
|
||||||
if(message.donnees[4] > 0 && message.donnees[4] < 30){
|
if(message.donnees[4] > 0 && message.donnees[4] < 30){
|
||||||
printf("LED ON\n");
|
//printf("LED ON\n");
|
||||||
gpio_put(PICO_DEFAULT_LED_PIN, 1);
|
gpio_put(PICO_DEFAULT_LED_PIN, 1);
|
||||||
}else{
|
}else{
|
||||||
printf("LED OFF\n");
|
//printf("LED OFF\n");
|
||||||
gpio_put(PICO_DEFAULT_LED_PIN, 0);
|
gpio_put(PICO_DEFAULT_LED_PIN, 0);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user