Profil: sermettur | DonanımHaber Forum

Şimdi Ara

@sermettur

Takip Et 0 takipçi

Özel Mesaj

11 Aralık 2013
Tarihinde Katıldı

Takip Ettikleri
0 üye

Görüntülenme
Toplam: 1 (Bu ay: 0)

Fırsat Ekle

Gönderileri

Tümü (1)

Sadece Konular (1)

Sadece Bağlantılar (0)

sermettur (sermet tür) · Arduino altına konu açtı. 7 yıl

3 akis gimbal

gimbal kamera yapıyorım ardiuno uno r3 mpu6050 3 ad servo malzemeler bunlar int indirdiğim kodlar aşağıda iyi çalışıyor ancak 2 akis 3 akis çalışması lazım uğraştım olmadı yardımcı olan arkadaşlara teşekkür ederim

// 2 axis 2 servo conrol using mpu 6050
#include <SPI.h>
#include <Wire.h>
#include <Servo.h>
#define MPU 0x68 // I2C address of the MPU-6050

Servo ServoX, ServoY;
double AcX,AcY,AcZ;
int Pitch, Roll;

void setup(){
Serial.begin(9600);
ServoX.attach(9);
ServoY.attach(10);
init_MPU(); // Initialisation of MPU6050
}

void loop()
{
FunctionsMPU(); // acquire Axis AcX, AcY, AcZ.

Roll = FunctionsPitchRoll(AcX, AcY, AcZ); // Roll
Pitch = FunctionsPitchRoll(AcY, AcX, AcZ); // Pitch

int ServoRoll = map(Roll, -90, 90, 0, 179);
int ServoPitch = map(Pitch, -90, 90, 179, 0);

ServoX.write(ServoRoll);
ServoY.write(ServoPitch);

Serial.print("Pitch: "); Serial.print(Pitch);
Serial.print("\t");
Serial.print("Roll: "); Serial.print(Roll);
Serial.print("\n");

}

void init_MPU(){
Wire.begin();
Wire.beginTransmission(MPU);
Wire.write(0x6B); // PWR_MGMT_1 register
Wire.write(0); // set to zero (wakes up the MPU-6050)
Wire.endTransmission(true);
delay(1000);
}

//Pitch and Roll
double FunctionsPitchRoll(double A, double B, double C){
double DatoA, DatoB, Value;
DatoA = A;
DatoB = (B*B) + (C*C);
DatoB = sqrt(DatoB);

Value = atan2(DatoA, DatoB);
Value = Value * 180/3.14;

return (int)Value;
}

//axis X,Y,Z MPU6050
void FunctionsMPU(){
Wire.beginTransmission(MPU);
Wire.write(0x3B); // starting with register 0x3B (ACCEL_XOUT_H)
Wire.endTransmission(false);
Wire.requestFrom(MPU,6,true); // request a total of 14 registers
AcX=Wire.read()<<8|Wire.read(); // 0x3B (ACCEL_XOUT_H) & 0x3C (ACCEL_XOUT_L)
AcY=Wire.read()<<8|Wire.read(); // 0x3D (ACCEL_YOUT_H) & 0x3E (ACCEL_YOUT_L)
AcZ=Wire.read()<<8|Wire.read(); // 0x3D (ACCEL_YOUT_H) & 0x3E (ACCEL_YOUT_L)
}

Yanıt Yok

Yanıtla

Favorilere Ekle

Temel Bilgiler ve İstatistikler

Aktiflik: Şu anda DH'de değil
Son Giriş: geçen yıl
Son Mesaj Zamanı: 7 yıl
Mesaj Sayısı: 10
Gerçek Toplam Mesaj Sayısı: 10
İkinci El Bölümü Mesajları: 0
Konularının görüntülenme sayısı: 88 (Bu ay: 1)
Toplam aldığı artı oy sayısı: 0 (Bu hafta: 0)
En çok mesaj yazdığı forum bölümü: 3D/Lazer Yazıcılar - Kesiciler - Oyucular

Mesajları

İkinci El Referansları