Ajout position 0 pour prise caisse noisette

This commit is contained in:
Samuel 2026-05-08 23:25:18 +02:00
parent 0c8053bd97
commit 9aaf048c24

46
main.c
View File

@ -24,6 +24,7 @@
bool bouton_Presser = false; bool bouton_Presser = false;
bool pas_a_pas_initialisé = false;
float v_actuelle_tr_s=0; float v_actuelle_tr_s=0;
float v_consigne_tr_s=0; float v_consigne_tr_s=0;
@ -188,7 +189,7 @@ void main(void)
gpio_set_dir(PIN_DIR, GPIO_OUT); gpio_set_dir(PIN_DIR, GPIO_OUT);
gpio_set_dir(PIN_ENABLE, GPIO_OUT); gpio_set_dir(PIN_ENABLE, GPIO_OUT);
gpio_put(PIN_ENABLE, 1); gpio_put(PIN_ENABLE, 1);
multicore_launch_core1(affiche_pas_de_temps); //multicore_launch_core1(affiche_pas_de_temps);
pince_ouvre(); pince_ouvre();
@ -205,6 +206,7 @@ void main(void)
if(sens_pas_a_pas==SENS_BAS && contacteur_bas.pos_valide == 1){ if(sens_pas_a_pas==SENS_BAS && contacteur_bas.pos_valide == 1){
pas_a_pas_stop(); pas_a_pas_stop();
pas_a_pas_initialisé = true;
pos_pas = 0; pos_pas = 0;
} }
@ -243,24 +245,42 @@ void main(void)
if(key == 'f' || key == 'F'){ if(key == 'f' || key == 'F'){
pince_ferme(); pince_ferme();
} }
if(key == '0'){
if(pas_a_pas_initialisé){
consigne_pas_a_pas=1000;
consigne_pas_a_pas_active=true;
if(pos_pas <consigne_pas_a_pas ){
pas_a_pas_monte();
}else{
pas_a_pas_descend();
}
}
}
if(key == '1'){ if(key == '1'){
consigne_pas_a_pas=5000; if(pas_a_pas_initialisé){
consigne_pas_a_pas_active=true; consigne_pas_a_pas=5000;
if(pos_pas <consigne_pas_a_pas ){ consigne_pas_a_pas_active=true;
pas_a_pas_monte(); if(pos_pas <consigne_pas_a_pas ){
}else{ pas_a_pas_monte();
pas_a_pas_descend(); }else{
pas_a_pas_descend();
}
} }
} }
if(key == '2'){ if(key == '2'){
consigne_pas_a_pas=15000; if(pas_a_pas_initialisé){
consigne_pas_a_pas_active=true; consigne_pas_a_pas=15000;
if(pos_pas <consigne_pas_a_pas ){ consigne_pas_a_pas_active=true;
pas_a_pas_monte(); if(pos_pas <consigne_pas_a_pas ){
}else{ pas_a_pas_monte();
pas_a_pas_descend(); }else{
pas_a_pas_descend();
}
} }
} }
if(key == '?'){
printf("A\n");
}
//printf("%c %d\n", key,key); //printf("%c %d\n", key,key);
} }