/*
// 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