3 Temmuz 2015 Cuma

Arduino Gimbal Kontrol Kartı

Herkese Merhabalar,
     Daha önce kolay bulunabilecek malzemelerden nasıl gimbal yapılabileceğinden bahsetmiştim (O yazıya buradan ulaşabiliriniz). Kontrol kartını sonra anlatacağım demiştim. Veee bu yazımda arduino ve MPU6050 sensörü kullanarak nasıl bir gimbal kontrol kartı yapabileceğimizden bahsedeceğim. Bu kart sayesinde gimbalin yere göre açısını kontrol edebileceğiz. Yere göre açısının sabit kalmasını da kontrol kartı üzerindeki IMU sensörü ile sağlayacağız(Ayrıntılı bilgi için tıklayınız). Kontrol kartı saniyede 100 değer okuyup servo PWM değerlerini ona göre güncelliyor. Bu sayede oldukça yüksek çözünürlüklü her türlü seviyede kullanılabilecek bir kontrol kartı yapmış oluyoruz. Ayrıca başa koyduğum ayar parametreleri sayesinde her boyutta ve çeşitte servo gimbale kolayca uyumlu hale getirilebilir. Kontrol kartının tanıtım videosu aşağıdadır.


      Bağlantılara gelecek olursak MPU6050 I2C pinlerinden arduinoya bağlanıyor. Gnd pini gndye, Vcc pini ise 3.3 volta bağlanıyor. Çalışma voltajı 3.3 volt olduğu için. Servoların sinyal pinlerini ayarlardan seçtiğimiz dijital pinlere bağlıyoruz. Servoların beslemesi eğer küçük servolar ise arduino üzerinden eğer yüksek akım çeken servolarsa harici olarak yapabilirsiniz. Fakat harici besleme yaparsanız arduino ve güç kaynağının topraklarını eşitlemeyi unutmayın.

////////////////////Ayarlar////////////////
//pitch
int p_pin=8;
int p_neturalpos=90;
int p_gain=1;
int p_min=30;
int p_max=150;
int p_reverse=0;
//roll
int r_pin=9;
int r_neturalpos=90;
int r_gain=1;
int r_min=30;
int r_max=150;
int r_reverse=0;

///////////////////////////////////////////////
Bunlar, koddaki ayar parametreleri, çeşitli gimballere kolay adapte edilebilmesi içindir. İlk pozisyonunu, en düşük, en yüksek servo açılarını, kazancını bu parametrelerle kontrol edeceğiz. Kazanç ise kontrol kartındaki açı değişimlerinin servoya kaçla çarpılarak yansıtılacağının parametresidir."Reverse" değişkeni "1" veya "0" yapılarak yönün ters çevirilmesi sağlanabilir. Benim gimbalim için "Pitch" eksenini ters yapmam gerekmişti.



Sistemin Fotoğrafları





Projenin full kaynak kodu:

#include <I2Cdev.h>
#include <MPU60X0.h>
#include <EEPROM.h>
#include "DebugUtils.h"
#include "CommunicationUtils.h"
#include "FreeIMU.h"
#include <Wire.h>
#include <SPI.h>
#include <Servo.h>
////////////////////Ayarlar////////////////
//pitch
int p_pin=8;
int p_neturalpos=90;
int p_gain=1;
int p_min=30;
int p_max=150;
int p_reverse=0;
//roll
int r_pin=9;
int r_neturalpos=90;
int r_gain=1;
int r_min=30;
int r_max=150;
int r_reverse=0;

///////////////////////////////////////////////
Servo pitchservo;
Servo rollservo;
int p_angle=90;
int r_angle=90;
int raw_values[9];
float ypr[3]; // yaw pitch roll
float val[9];

FreeIMU my3IMU = FreeIMU();

void setup() {
  Serial.begin(115200);
  pitchservo.attach(p_pin);
  rollservo.attach(r_pin);
  Wire.begin();
  delay(5);
  my3IMU.init();
  delay(5);
}

void loop() {

  my3IMU.getYawPitchRoll(ypr);
  Serial.print("Yaw: ");
  Serial.print(ypr[0]);
  Serial.print(" Pitch: ");
  Serial.print(ypr[1]);
  Serial.print(" Roll: ");
  Serial.print(ypr[2]);
  Serial.println("");


  p_angle=p_neturalpos+ypr[1]*p_gain;
  if(p_angle>p_max){
    p_angle=p_max;
  }
  if(p_angle<p_min){
    p_angle=p_min;
  }
  if(p_reverse=1){
    p_angle=180-p_angle;
  }
  pitchservo.write(p_angle);



  r_angle=r_neturalpos+ypr[2]*r_gain;
  if(r_angle>r_max){
    r_angle=r_max;
  }
  if(r_angle<r_min){
    r_angle=r_min;
  }
  if(r_reverse=1){
    r_angle=180-r_angle;
  }
  rollservo.write(r_angle);

  delay(10);
}

3 yorum:

  1. emeğiniz için çok teşekkür ederim. :)

    YanıtlaSil
  2. emeğiniz için çok teşekkür ederim. :)

    YanıtlaSil
  3. bana e-posta lütfen kod hatası derlenmiş yardım bana veriyor

    YanıtlaSil