Advertisement
AntonioVillanueva

Control Servo Motor wiringPi Raspberry

Apr 25th, 2017
221
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.79 KB | None | 0 0
  1. //g++ -o  servo servo.cc -lwiringPi -lpthread
  2. #include <iostream>
  3. #include <wiringPi.h>
  4. #include <softPwm.h>
  5.  
  6. using namespace std;
  7. #define BARRIERE0 26//pwm0 BCM12 PIN 32
  8. #define BARRIERE1 23//pwm1 BCM13 PIN 33
  9. #define INIT_VALUE 4//Valeur initial servo moteur
  10. #define RANGE 200//Valeur final servo moteur
  11.  
  12.  
  13. int main (){
  14.     int degrees0(4);
  15.     int degrees1(4);
  16.  
  17.     if (wiringPiSetup()==-1 ) {cout <<"Erreur !"<<endl;return 1;}
  18.  
  19.     softPwmCreate(BARRIERE0,INIT_VALUE,RANGE);
  20.     delay(10);
  21.     softPwmCreate(BARRIERE1,INIT_VALUE,RANGE);
  22.     delay(10);
  23. //Control Barriere 3 - 13
  24.     while (TRUE){
  25.  
  26.         cin>>degrees0;
  27.         if (degrees0>RANGE/10){degrees0=3;}
  28.         softPwmWrite(BARRIERE0,degrees0);
  29.  
  30.         cin>>degrees1;
  31.         if (degrees1>RANGE/10){degrees1=3;}
  32.         softPwmWrite(BARRIERE1,degrees1);
  33.  
  34.     }
  35.     return 0;
  36. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement