Monday, July 10, 2017

Multi Servo Sketch

/*
// Experimental sketch
// BT app with sound
// pwm 3,5,6,9,10,11
//  */


....


#include <Servo.h>

char data = 0;
Servo mHead;
Servo rightFront;
Servo rightBack;
Servo leftFront;
Servo leftBack;
int pos = 0;
int x= 1000;
int  var = 0;          
int led = 13;      
int val = 0;                 


// ENABLE PWM 3,5,6,9,10,11

void setup() {
    Serial.begin(9600);
      pinMode(13, OUTPUT);
     mHead.attach(10); 
     rightFront.attach(9);    
     rightBack.attach(7);  
     leftFront.attach(6);
     leftBack.attach(8); 
  }

void loop() {
    //stand();
    // delay(x);
   walkrf();
  delay(x);
  walkrb();
  delay(x);
   walklf();
   delay(x);
  walklb();
   delay(x);
}
  

void walkrf()   //ok
{
   rightFront.write(120);               //140 rtfr
   rightBack.write(90);               //90    lffr
  // leftFront.write(90);              //90   rtbk
  // leftBack.write(90);              //90  lfbk
}

void walkrb()
{
   rightFront.write(90);               //90 rtfr
   rightBack.write(120);               //110    lffr
   //leftFront.write(90);              //90  rtbk
   leftBack.write(90);              //90)  lfbk
}

void walklf()     //ok
{
  // rightFront.write(90);               //90 rtfr
  // rightBack.write(90);               //90    lffr
   leftFront.write(50);              //60  rtbk
   leftBack.write(90);              //90  lfbk
}

void walklb()
{
  // rightFront.write(90);               //90 rtfr
   //rightBack.write(90);               //90    lffr
   leftFront.write(90);              //90  rtbk
   leftBack.write(115);              //100  lfbk
}


void stand()
{
   rightFront.write(100);               //105 rtfr
   rightBack.write(90);               //85    lffr
   leftFront.write(90);              //105-70   rtbk
   leftBack.write(90);              //120-85(140)  lfbk
}

No comments:

Post a Comment