Belajar

Ukur kemiringan dengan MPU6050 dan Arduino

Menengah

Atau lihat semua pelajaran.

  • 526komponen di meja kerja
  • 46board sedang berjalan
  • 1.00xwaktu nyata, di semua board
Arduino Uno: pengukur kemiringan MPU6050live0.000 s 0.00x
Klik untuk membukanya di editor
Contoh pengukur kemiringan: MPU6050 di A4 dan A5 serta tiga lampu. Buka di editor dan seret sensornya untuk memiringkannya.

MPU6050 adalah akselerometer tiga sumbu dan giroskop tiga sumbu dalam satu chip, biasanya dijual di board biru kecil GY-521. Rangkaian di atas memakainya sebagai pengukur kemiringan: Arduino Uno membacanya lewat I2C, menyalakan lampu hijau saat datar, dan lampu merah atau biru saat dimiringkan ke kiri atau kanan. Serial monitor mencetak percepatan mentah, sudut roll dan pitch, laju gyro, serta suhu chip itu sendiri.

Buka di editor dan seret board sensornya untuk memiringkannya. Pembacaan mengikuti gravitasi, dan gyro mengikuti seberapa cepat kamu menggerakkannya.

Yang kamu butuhkan

  • Arduino Uno
  • MPU6050 di board GY-521
  • LED merah, hijau dan biru dengan resistor 220 ohm masing-masing
  • Breadboard dan kabel jumper

Pengkabelan

Komponen dan pinDisambung keCatatan
SCL MPU6050A5Board GY-521 membawa pull-up-nya sendiri
SDA MPU6050A4
VCC dan GND MPU60505 V dan GND
LED merah, lewat 220 ohmPin 7Dimiringkan ke kiri
LED hijau, lewat 220 ohmPin 8Datar
LED biru, melalui 220 ohmPin 9Dimiringkan ke kanan

Ia menyala dalam keadaan tidur

Setelah reset, register manajemen daya MPU6050 berisi 0x40: bit tidur aktif. Sampai sebuah sketch menghapusnya, setiap register pengukuran berisi nol. Tidak ada error, tidak ada keluhan, hanya ketiadaan yang sempurna dan stabil, yang lebih buruk dari crash karena terlihat seperti sensor yang bekerja, tergeletak datar dan diam. Tindakan pertama setiap driver adalah menulis 0x00 ke register 0x6B, dan contohnya mencetak apakah itu berhasil.

Chip simulasi juga menyala dalam keadaan tidur, jadi lupa hal ini memberikan nol yang stabil yang sama di sini seperti di meja kerja.

Membangunkannya dengan panggilan Wire biasa
#include <Wire.h>

void setup() {
  Serial.begin(9600);
  Wire.begin();
  Wire.beginTransmission(0x68);
  Wire.write(0x6B);   // PWR_MGMT_1
  Wire.write(0x00);   // clear SLEEP
  Wire.endTransmission();
}

Mengubah gravitasi menjadi sudut

An accelerometer sitting still measures gravity and nothing else. Flat on a table, all of gravity is on the Z axis, so the reading is 0, 0 and plus 1 g. Tip it to one side and some of gravity moves onto Y; tip it forward and some moves onto X. The tilt angle is the arctangent of the two components, which is the whole trick behind every spirit level app.

Contohnya membaca keempat belas byte data sekaligus, mengubah angka mentah menjadi seperseribu g, dan menghitung roll dari Y dan Z serta pitch dari X dan Z. Arctangen berasal dari tabel lookup yang akurat sampai sekitar satu derajat, lebih cepat dan kecil di Uno daripada atan2() dari math library, meskipun atan2() juga bisa. Lewat 12 derajat ke arah mana pun, salah satu lampu luar menggantikan lampu hijau.

Giroskop mengukur hal yang berbeda: seberapa cepat board berputar, dalam derajat per detik, bukan ke mana ia mengarah. Ia berada di sekitar nol saat board diam dan bergerak hanya saat kamu memiringkannya.

WHO_AM_I dan alamatnya

Alamat chip adalah 0x68, atau 0x69 jika pin AD0 ditarik ke tinggi. Register WHO_AM_I-nya mengembalikan 0x68 pada kedua kasus, karena register itu menyimpan bit alamat tanpa AD0. Jadi driver yang membandingkan WHO_AM_I dengan alamat yang dipakainya akan gagal tepat di board yang dipasang ke 0x69. Contoh ini mencetak keduanya, jadi bedanya terlihat.

Coba di editor

Buka rangkaian di editor dan seret board sensor untuk memiringkannya perlahan melewati 12 derajat. Lampu hijau menyerah ke merah atau biru. Ubah FLAT_DEGREES ke 3 dan meterannya menjadi waterpas yang gampang panik; ubah ke 30 dan dia hanya protes kalau benar-benar miring.

Watch the gyro numbers in the serial monitor while you drag. They rise while the board is moving and fall back to zero the moment you stop, even though the tilt stays. That is the difference between a rate and a position, and it is why a gyro on its own cannot tell you which way up something is.

Lalu tulis beberapa baris kode sendiri dengan Wire.h: transmisi ke 0x68 dengan register 0x75, WHO_AM_I, dan baca satu byte. Hasilnya mencetak 68, sama seperti chip sungguhan.

Kesalahan umum

Forgetting to wake it, and getting zeros.

Membaca register satu per satu. Enam byte akselerasi bisa berubah di antara dua pembacaan terpisah, sehingga menghasilkan nilai yang setengahnya dari satu sampel dan setengahnya dari sampel berikutnya. Baca bloknya dalam satu transfer.

Mengharapkan sudut dari gyro saja. Integral derajat per detik seiring waktu akan bergeser (drift). Proyek sungguhan menggabungkan akselerometer dan gyro dengan filter complementary atau Kalman.

Mengharapkan angka sempurna dari hardware sungguhan. MPU6050 sungguhan punya offset di setiap sumbu sampai dikalibrasi. Yang disimulasikan membaca bersih, yang berguna untuk belajar matemanya dan lebih ramah daripada meja kerja.

Buka rangkaian ini di editor. Arduino Uno: MPU6050 tilt meter, sudah terangkai seperti contoh di bagian atas halaman ini. Ubah komponen atau nilainya lalu jalankan lagi.

Buka rangkaian ini

Pertanyaan

Apakah aku perlu library untuk MPU6050?

Tidak. Wire.h terkompilasi di sini apa adanya, dan membangunkan serta membaca chip hanya butuh beberapa tulis register dan satu burst read. Contohnya memakai helper MPU6050 milik Mokxi, yang membungkus persis hal itu.

Bisakah aku memakai MPU6050 dengan ESP32?

Bisa. Chip ini berjalan di 3,3 volt dan pembacaan register yang sama bekerja di pin I2C ESP32.

Apakah simulator punya DMP?

Tidak. Pemroses gerak di dalam chip sungguhan, yang menjalankan firmware fusion-nya sendiri, tidak dimodelkan. Register akselerometer, gyro, dan suhu mentahnya ada.

Rakit versi nyatanya

Buka editor, ubah sebuah nilai, dan lihat angkanya ikut berubah. Tidak ada yang perlu dipasang, dan tidak perlu akun.