modelec/servo_moteurs
1
0
Fork 0
mirror of https://github.com/modelec/servo_moteurs.git synced 2026-01-18 16:47:23 +01:00
Code Issues Packages Projects Releases Wiki Activity

Chabgement du sleep dans boucles bras

Browse Source
This commit is contained in:
bap
2024-04-17 18:28:55 +02:00
parent 224bb5cf3a
commit 6ea98b55d7
1 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
MyTCPClient.cpp
View File

@@ -88,15 +88,15 @@ void MyTCPClient::baisser_bras() {
case BRAS_HAUT:
for(int i = angleBrasHaut.servo4; i <= angleBrasBas.servo4;i++){
this->pwm_setServoPosition(4, i);
this->pwm_setServoPosition(5, angleBrasHaut.servo5-i-angleBrasHaut.servo4);
usleep(5'000);
this->pwm_setServoPosition(5, angleBrasHaut.servo5-i-angleBrasHaut.servo4);
}
break;
case BRAS_TRANSPORT:
for(int i = angleBrasTransport.servo4; i <= angleBrasBas.servo4;i++){
this->pwm_setServoPosition(4, i);
this->pwm_setServoPosition(5, angleBrasTransport.servo5-i-angleBrasTransport.servo4);
usleep(5'000);
this->pwm_setServoPosition(5, angleBrasTransport.servo5-i-angleBrasTransport.servo4);
}
break;
case BRAS_BAS:
@@ -113,15 +113,15 @@ void MyTCPClient::transport_bras(){
switch(this->positionBras){
case BRAS_BAS:
for (int i = angleBrasBas.servo5; i <= angleBrasTransport.servo5; i++){
usleep(5'000);
this->pwm_setServoPosition(4, angleBrasBas.servo4-i-angleBrasBas.servo5);
usleep(5'000);
this->pwm_setServoPosition(5, i);
}
break;
case BRAS_HAUT:
for (int i = angleBrasHaut.servo4; i <= angleBrasTransport.servo4; i++){
usleep(5'000);
this->pwm_setServoPosition(4, i);
usleep(5'000);
this->pwm_setServoPosition(5, angleBrasHaut.servo5-i-angleBrasHaut.servo4);
}
break;
@@ -140,15 +140,15 @@ void MyTCPClient::lever_bras() {
case BRAS_BAS:
for (int i = angleBrasBas.servo5;i <= angleBrasHaut.servo5;i++){
this->pwm_setServoPosition(4, angleBrasBas.servo4-i-angleBrasBas.servo5);
this->pwm_setServoPosition(5, i);
usleep(5'000);
this->pwm_setServoPosition(5, i);
}
break;
case BRAS_TRANSPORT:
for (int i = angleBrasTransport.servo5;i <= angleBrasHaut.servo5;i++){
this->pwm_setServoPosition(4, angleBrasTransport.servo4-i-angleBrasTransport.servo5);
this->pwm_setServoPosition(5, i);
usleep(5'000);
this->pwm_setServoPosition(5, i);
}
break;
case BRAS_HAUT: