MPU6050 merupakan sebuah sensor yang berfungsi untuk mengukur percepatan suatu benda yang bergerak. Nah kali ini kita akan belajar untuk mengontrol servo. Jadi nanti hasilnya adalah servo akan mengikuti pergerakan dari sensor MPU6050 ini. Module ini menggunakan i2c yaitu SDA dan SCL dan 2 pin lagi VCC GND sebagai power. Oke langsung saja ya kita coba, berikut adalah alat dan bahan yang dibutuhkan.

Alat dan bahan

Rangkaian

Sketch Program

#include "Wire.h"
#include "I2Cdev.h"
#include "MPU6050.h"
#include "Servo.h"

MPU6050 mpu;

int16_t ax, ay, az;
int16_t gx, gy, gz;

Servo myservo;

int val;
int prevVal;

void setup(){
  Wire.begin();
  Serial.begin(38400);

  Serial.println("Initialize MPU");
  mpu.initialize();
  Serial.println(mpu.testConnection() ? "Connected" : "Connection failed");
  myservo.attach(3); //pin servo
}

void loop() {
  mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);

  val = map(ay, -17000, 17000, 0, 179);
  if (val != prevVal)
  {
    myservo.write(val);
    prevVal = val;
  }
  delay(50);
}

Masukkan library MPU6050 dan I2Cdev, jika sudah upload program seperti biasa pada Aruino IDE dengan Board : Arduino/Genuino Uno. Pastikan Port terceklis. 

Dan silahkan di uji coba dengan menggerakkan MPU6050.

Semoga bermanfaat.

Kategori: Arduino

Tinggalkan Balasan

Alamat email Anda tidak akan dipublikasikan. Ruas yang wajib ditandai *

Scroll Up
id_IDIndonesian
en_USEnglish id_IDIndonesian