Ukur kemiringan dengan MPU6050 dan Arduino
Menengah
Atau lihat semua pelajaran.
- 526komponen di meja kerja
- 46board sedang berjalan
- 1.00xwaktu nyata, di semua board
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 pin | Disambung ke | Catatan |
|---|---|---|
| SCL MPU6050 | A5 | Board GY-521 membawa pull-up-nya sendiri |
| SDA MPU6050 | A4 | |
| VCC dan GND MPU6050 | 5 V dan GND | |
| LED merah, lewat 220 ohm | Pin 7 | Dimiringkan ke kiri |
| LED hijau, lewat 220 ohm | Pin 8 | Datar |
| LED biru, melalui 220 ohm | Pin 9 | Dimiringkan 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.
#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 iniPertanyaan
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.
Lanjutkan
Rakit versi nyatanya
Buka editor, ubah sebuah nilai, dan lihat angkanya ikut berubah. Tidak ada yang perlu dipasang, dan tidak perlu akun.