Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- class Hand {
- static const int NUM_FINGERS = 5;
- Servo fingerServos[NUM_FINGERS];
- public:
- Hand(int thumbPin, int indexPin, int middlePin, int ringPin, int littlePin) {
- fingerServos[0].attach(thumbPin);
- fingerServos[1].attach(indexPin);
- fingerServos[2].attach(middlePin);
- fingerServos[3].attach(ringPin);
- fingerServos[4].attach(littlePin);
- }
- void alltomax() {
- for(int i = 0; i < numFingers; i++){
- fingerServos[i].write(90);
- }
- }
- void alltorest() {
- for(int i = 0; i < numFingers; i++){
- fingerServos[i].write(0);
- }
- }
- };
- Hand hand = Hand(1, 2, 3, 4, 5);
- double delayTime = 4000;
- void setup() {
- }
- void loop() {
- hand.alltorest();
- delay(delayTime);
- hand.alltomax();
- delay(delayTime / 2);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement