Keuronde/RPiPico-Holonome2023
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Optimisation de la trajectoire pour revenir de Cerise Bas

Browse Source
This commit is contained in:
Samuel 2023-05-20 16:38:52 +02:00
parent 4d29a0918a
commit 880ba8cce9
1 changed files with 7 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
Strategie.c
View File

@ -386,9 +386,9 @@ enum etat_action_t Strategie_aller_panier(enum couleur_t couleur, uint32_t step
// Sinon, on a une courbe de bézier
Trajet_config(500,250);
Trajectoire_bezier(&trajectoire,Localisation_get().x_mm, Localisation_get().y_mm,
485, Localisation_get().y_mm,
465, 857,
465,2830,
418, Localisation_get().y_mm,
655, 2800,
180, 2800,
Localisation_get().angle_radian,
Geometrie_get_angle_optimal(Localisation_get().angle_radian, +120. * DEGRE_EN_RADIAN));
}
@ -410,12 +410,11 @@ enum etat_action_t Strategie_aller_panier(enum couleur_t couleur, uint32_t step
// Sinon, on a une courbe de bézier
Trajet_config(500,250);
Trajectoire_bezier(&trajectoire,Localisation_get().x_mm, Localisation_get().y_mm,
2000-485, Localisation_get().y_mm,
2000-465, 857,
2000-465, 2830,
Localisation_get().angle_radian, Geometrie_get_angle_optimal(Localisation_get().angle_radian, -240. * DEGRE_EN_RADIAN));
2000 - 418, Localisation_get().y_mm,
2000 - 655, 2800,
2000 - 180, 2800,
Localisation_get().angle_radian, Geometrie_get_angle_optimal(Localisation_get().angle_radian, -240. * DEGRE_EN_RADIAN));
}
}
// parcours du trajet