February 24, 2019
Description
sg 90 servo is used in the project but because the torque is low, I used mg995 because it is stronger. so I redesigned the servo neck holder.
/**********************************
< WALL-E >
< ERHAN ÖZTÜRK >
***********************************/
#include <Servo.h>
Servo myservo1, myservo2, myservo3;
void setup()
{
myservo1.attach(3); // kafa sağ sol
myservo2.attach(4); // Sağ tarafdaki servo.İleri-Geri
myservo3.attach(5); // Sol tarafdaki servo.İleri-Geri
Serial.begin(9600); // Seri haberleşme hızı
}
void loop()
{
///////////// BLUETOOTH HABERLEŞMESİ //////////////////////////////////////////////////////////////
if(Serial.available()>= 2 ) ///////////////////////////////////////////////
{ //
unsigned int servopos = Serial.read(); // Bluetooth ile gönderilen veri 2bytelıktır.
unsigned int servopos1 = Serial.read(); // Gelen veri okunur ve Serial ekrana yazdırılır.
unsigned int data = (servopos1 *256) + servopos; //
Serial.println(data); /////////////////////////////////////////////////
///////////////////////////////////////////////////////////////////////////////////////////////////////
///////////// SERVO KONTROLLERİ ///////////////////////////////////////////////////////////////////////
if (data >= 1000 && data <1180) ////////////////////////////////////////////////
{ //
int servo1 = data; // Gelen veri 1000-1180 arasında ise gelen veri
servo1 = map(servo1, 1000,1180,1,170); // map fonksiyonu ile 80-170 arasına sığdırılır
myservo1.write(servo1); // ve servo1 isimli servoya o değer verilir
delay(10); //
} /////////////////////////////////////////////////
if (data >=2000 && data <2180) ////////////////////////////////////////////////
{ //
int servo2 = data; // Gelen veri 2000-2180 arasında ise gelen veri
servo2 = map(servo2,2000,2180,1,180); // map fonksiyonu ile 30-120 arasına sığdırılır
myservo2.write(servo2); // ve servo2 isimli servoya o değer verilir.
delay(10); //
} /////////////////////////////////////////////////
if (data >=3000 && data < 3180) /////////////////////////////////////////////////
{ //
int servo3 = data; // Gelen veri 3000-3180 arasında ise gelen veri
servo3 = map(servo3, 3000, 3180,1,180); // map fonksiyonu ile 80-140 arasına sığdırılır
myservo3.write(servo3); // ve servo3 isimli servoya o değer verilir.
delay(10); //
}
}
}
License:
Creative Commons - Attribution - Share Alike