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

Début du mode test

Browse Source
This commit is contained in:
Samuel 2022-11-18 15:44:34 +01:00
parent 72e7c472ee
commit e6de7a72fd
1 changed files with 36 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

36
test.c
View File

@ -12,6 +12,10 @@ const uint LED_PIN = 25;
#define V_INIT -999.0 #define V_INIT -999.0
int mode_test();
int test_moteurs();
int main() { int main() {
bi_decl(bi_program_description("This is a test binary.")); bi_decl(bi_program_description("This is a test binary."));
bi_decl(bi_1pin_with_name(LED_PIN, "On-board LED")); bi_decl(bi_1pin_with_name(LED_PIN, "On-board LED"));
@ -34,6 +38,9 @@ int main() {
//while(1); //while(1);
Temps_init(); Temps_init();
Gyro_Init(); Gyro_Init();
while(mode_test());
temps_ms = Temps_get_temps_ms(); temps_ms = Temps_get_temps_ms();
temps_ms_old = temps_ms; temps_ms_old = temps_ms;
while (1) { while (1) {
@ -85,3 +92,32 @@ int main() {
} }
} }
} }
// Mode test : renvoie 0 pour quitter le mode test
int mode_test(){
printf("Appuyez sur une touche pour entrer en mode test :\n");
printf("M - pour les moteurs\n");
int rep = getchar_timeout_us(10000000);
switch (rep)
{
case 'M':
/* code */
break;
case PICO_ERROR_TIMEOUT:
printf("Sortie du mode test\n");
return 0;
default:
printf("Commande inconnue\n");
return 1;
break;
}
}
int test_moteurs(){
printf("Indiquez le moteurs à tester (A, B ou C):\n");
int moteur = getchar_timeout_us(0);
printf("Moteur choisi : %d %x", moteur, moteur);
}