Correction des positions de démarrage

This commit is contained in:
Samuel 2025-01-25 17:02:34 +01:00
parent 8392148a16
commit 44c8c72993
2 changed files with 7 additions and 6 deletions

View File

@ -61,13 +61,13 @@ void Servomoteur_init(){
void Servo_pince_tient(){
pwm_set_chan_level(2, PWM_CHAN_A, 2800);
pwm_set_chan_level(5, PWM_CHAN_B, 1500);
pwm_set_chan_level(5, PWM_CHAN_B, 1350);
pwm_set_chan_level(2, PWM_CHAN_B, 2650);
}
void Servo_pince_lache(){
pwm_set_chan_level(2, PWM_CHAN_A, 1700);
pwm_set_chan_level(5, PWM_CHAN_B, 2700);
pwm_set_chan_level(5, PWM_CHAN_B, 2550);
pwm_set_chan_level(2, PWM_CHAN_B, 1500);
}

9
main.c
View File

@ -51,8 +51,8 @@ void main(void)
vitesse_angle = reception[2] - 128;
switch(reception[3]){
case 0: Servo_pince_tient(); break;
case 1: Servo_pince_lache(); break;
case 0: Servo_pince_lache(); break;
case 1: Servo_pince_tient(); break;
}
switch(reception[4]){
@ -60,8 +60,9 @@ void main(void)
case 1: Servo_deplie_banderole(); break;
}
switch(reception[5]){
case 0: Servo_came_pousse(); break;
case 1: Servo_came_neutre(); break;
case 0: Servo_came_neutre(); break;
case 1: Servo_came_pousse(); break;
}
}