Arduino Wireless Animatronic Hand (5 / 5 steg)
Steg 5: Koden
Skicka Xbee handske:
int Finger1 = 0;
int Finger2 = 1;
int Finger3 = 2;
int Finger4 = 3;
int Finger5 = 4;
void setup()
{
Serial.BEGIN(9600);
}
void loop()
{
byte servoValue1;
byte servoValue2;
byte servoValue3;
byte servoValue4;
byte servoValue5;
int FingerV1 = analogRead(Finger1);
int FingerV2 = analogRead(Finger2);
int FingerV3 = analogRead(Finger3);
int FingerV4 = analogRead(Finger4);
int FingerV5 = analogRead(Finger5);
om (FingerV1 < 200) FingerV1 = 200.
annars om (FingerV1 > 460) FingerV1 = 460;
om (FingerV2 < 200) FingerV2 = 200.
annars om (FingerV2 > 460) FingerV2 = 460;
om (FingerV3 < 200) FingerV3 = 200.
annars om (FingerV3 > 460) FingerV3 = 460;
om (FingerV4 < 200) FingerV4 = 200.
annars om (FingerV4 > 460) FingerV4 = 460;
om (FingerV5 < 200) FingerV5 = 200.
annars om (FingerV5 > 460) FingerV5 = 460;
byte servoVal1 = karta (FingerV1, 460, 200, 255, 0);
byte servoVal2 = karta (FingerV2, 460, 200, 255, 0);
byte servoVal3 = karta (FingerV3, 460, 200, 255, 0);
byte servoVal4 = karta (FingerV4, 460, 200, 255, 0);
byte servoVal5 = karta (FingerV5, 460, 200, 255, 0);
Serial.Print(servoVal1);
Serial.Print(servoVal2);
Serial.Print(servoVal3);
Serial.Print(servoVal4);
Serial.Print(servoVal5);
Delay(100);
}
Gemensamma vinkel till inre värde tillbaka till gemensamma vinkel
Ta emot xbee Hand:
#include < Servo.h >
Servo myservo1; skapa objekt för att styra en servo servo
Servo myservo2;
Servo myservo3;
Servo myservo4;
Servo myservo5;
void setup()
{
Serial.BEGIN(9600);
myservo1.attach(2); tillmäter objektet servo servo på pin 9
myservo2.attach(3);
myservo3.attach(4);
myservo4.attach(5);
myservo5.attach(6);
}
void loop()
{
IF(Serial.available() > = 5)
{
byte servoAng1 = Serial.read();
byte servoAng2 = Serial.read();
byte servoAng3 = Serial.read();
byte servoAng4 = Serial.read();
byte servoAng5 = Serial.read();
Skicka servo till position läsa... <--du får göra detta hända
myservo1.write(servoAng1);
myservo2.write(servoAng2);
myservo3.write(servoAng3);
myservo4.write(servoAng4);
myservo5.write(servoAng5);
}
}