Advertisement
Guest User

Untitled

a guest
Jul 23rd, 2018
73
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.87 KB | None | 0 0
  1. #include <Servo.h>
  2.  
  3. class Hand {
  4.   static const int NUM_FINGERS = 5;
  5.   Servo fingerServos[NUM_FINGERS];
  6.  
  7.   public:
  8.   Hand(int thumbPin, int indexPin, int middlePin, int ringPin, int littlePin) {
  9.     fingerServos[0].attach(thumbPin);
  10.     fingerServos[1].attach(indexPin);
  11.     fingerServos[2].attach(middlePin);
  12.     fingerServos[3].attach(ringPin);
  13.     fingerServos[4].attach(littlePin);
  14.   }
  15.  
  16.   void alltomax() {  
  17.     for(int i = 0; i < numFingers; i++){
  18.       fingerServos[i].write(90);      
  19.     }
  20.   }
  21.  
  22.   void alltorest() {        
  23.     for(int i = 0; i < numFingers; i++){
  24.       fingerServos[i].write(0);      
  25.     }
  26.   }
  27. };
  28.  
  29. Hand hand = Hand(1, 2, 3, 4, 5);
  30. double delayTime = 4000;
  31.  
  32. void setup() {
  33. }
  34.  
  35. void loop() {
  36.   hand.alltorest();          
  37.   delay(delayTime);          
  38.   hand.alltomax();      
  39.   delay(delayTime / 2);          
  40. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement