Angle progressif pano

This commit is contained in:
bap
2024-04-18 17:46:16 +02:00
parent 70c57d2652
commit b63636e373
2 changed files with 9 additions and 2 deletions

View File

@@ -222,11 +222,15 @@ void MyTCPClient::ouvrir_pince(int pince, bool force) {
void MyTCPClient::check_panneau(int quelBras) {
this->pwm_setServoPosition(quelBras, 30);
for (int i = PANO_BAS; i <= PANO_HAUT;i++){
this->pwm_setServoPosition(quelBras, i);
}
}
void MyTCPClient::uncheck_panneau(int quelBras) {
this->pwm_setServoPosition(quelBras, 0);
for (int i = PANO_HAUT; i >= PANO_BAS;i--){
this->pwm_setServoPosition(quelBras, i);
}
}
void MyTCPClient::pwm_clear() {

View File

@@ -9,6 +9,9 @@
#define SERVO_MIN 82 // 0.02*4096
#define SERVO_MAX 492 // 0.12*4096
#define PANO_HAUT 25
#define PANO_BAS 5
enum BrasState {
BRAS_BAS,