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 "Asser_Moteurs.h"
|
||||
|
||||
#define ASSERMOTEUR_GAIN_P 300000.f
|
||||
#define ASSERMOTEUR_GAIN_I 30000.f
|
||||
#define ASSERMOTEUR_GAIN_P 30000.f
|
||||
#define ASSERMOTEUR_GAIN_I 3000.f
|
||||
|
||||
float consigne_mm_s[3]; // Consigne de vitesse (en mm/s)
|
||||
float commande_I[3]; // Terme integral
|
||||
|
||||
@ -2,8 +2,8 @@
|
||||
#include "Commande_vitesse.h"
|
||||
#include "math.h"
|
||||
|
||||
#define GAIN_P_POSITION 15
|
||||
#define GAIN_P_ORIENTATION 10
|
||||
#define GAIN_P_POSITION 5
|
||||
#define GAIN_P_ORIENTATION 5
|
||||
|
||||
#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);
|
||||
trajectoire = msg_trajectoire.trajectoire;
|
||||
mode = 4;
|
||||
Trajet_config(100, 100);
|
||||
Trajet_config(200, 100);
|
||||
|
||||
// Oh la la !
|
||||
}
|
||||
@ -212,10 +212,10 @@ void main(void)
|
||||
registre = message.donnees[2];
|
||||
if(id_carte == 'D'){
|
||||
if(message.donnees[4] > 0 && message.donnees[4] < 30){
|
||||
printf("LED ON\n");
|
||||
//printf("LED ON\n");
|
||||
gpio_put(PICO_DEFAULT_LED_PIN, 1);
|
||||
}else{
|
||||
printf("LED OFF\n");
|
||||
//printf("LED OFF\n");
|
||||
gpio_put(PICO_DEFAULT_LED_PIN, 0);
|
||||
}
|
||||
}
|
||||
|
||||
Loading…
Reference in New Issue
Block a user