Test avec le cas du servo qui reboucle au bout de 21 tours en mode "basse résolution"
This commit is contained in:
parent
18fa86c539
commit
f2c39d9117
@ -124,7 +124,7 @@ enum etat_t mouvement_servomoteur(){
|
|||||||
// On avance ou recule de d'un pas
|
// On avance ou recule de d'un pas
|
||||||
position += pas_servo;
|
position += pas_servo;
|
||||||
// si position > 5000 ou position < 0
|
// si position > 5000 ou position < 0
|
||||||
if(position > 20100 || position < 0){
|
if(position > 40100 || position < 0){
|
||||||
pas_servo = -pas_servo;
|
pas_servo = -pas_servo;
|
||||||
}
|
}
|
||||||
sms_sts.WritePosEx(SERVO_ID, position, 4800);
|
sms_sts.WritePosEx(SERVO_ID, position, 4800);
|
||||||
@ -145,7 +145,7 @@ enum etat_t mouvement_servomoteur(){
|
|||||||
}
|
}
|
||||||
|
|
||||||
int lire_registre(int servo_id, int registre_adresse){
|
int lire_registre(int servo_id, int registre_adresse){
|
||||||
return sms_sts.readByte(servo_id, registre_adresse); // Resolution à 1
|
return sms_sts.readByte(servo_id, registre_adresse);
|
||||||
}
|
}
|
||||||
|
|
||||||
void lire_tous_les_registres(int servo_id){
|
void lire_tous_les_registres(int servo_id){
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user