Học

Đo độ nghiêng với MPU6050 và một Arduino

Trung bình

Hoặc xem mọi bài học.

  • 526linh kiện trên bàn làm mạch
  • 46bo mạch đang chạy
  • 1.00xthời gian thực, trên mọi bo mạch
Arduino Uno: máy đo nghiêng MPU6050trực tiếp0.000 s 0.00x
Nhấp để mở trong trình soạn thảo
Ví dụ máy đo nghiêng: một MPU6050 trên A4 và A5 cùng ba đèn. Mở trong trình soạn thảo và kéo cảm biến để nghiêng nó.

MPU6050 là gia tốc kế ba trục và con quay hồi chuyển ba trục trên một chip, thường bán trên bo mạch xanh nhỏ GY-521. Mạch trên dùng nó làm máy đo nghiêng: một Arduino Uno đọc nó qua I2C, sáng đèn xanh lá khi nằm phẳng, và đèn đỏ hoặc đèn xanh dương khi nghiêng trái hoặc phải. Serial Monitor in gia tốc thô, các góc roll và pitch, tốc độ con quay và nhiệt độ riêng của chip.

Mở trong trình soạn thảo và kéo bo cảm biến để nghiêng nó. Số đo đi theo trọng lực, và con quay đi theo tốc độ bạn nghiêng nó.

Những gì bạn cần

  • Một Arduino Uno
  • Một MPU6050 trên bo GY-521
  • LED đỏ, xanh lá và xanh dương, mỗi đèn một điện trở 220 ohm
  • Một breadboard và dây cắm

Đi dây

Linh kiện và chânNối tớiGhi chú
SCL của MPU6050A5Bo GY-521 có sẵn điện trở kéo lên của riêng nó
SDA của MPU6050A4
VCC và GND của MPU60505 V và GND
LED đỏ, qua điện trở 220 ohmChân 7Nghiêng trái
LED xanh lá, qua điện trở 220 ohmChân 8Phẳng
LED xanh dương, qua 220 ohmChân 9Nghiêng phải

Nó khởi động ở trạng thái ngủ

Sau khi reset, thanh ghi quản lý nguồn của MPU6050 đọc được 0x40: bit ngủ đang bật. Cho đến khi sketch xóa nó, mọi thanh ghi đo lường đều đọc bằng không. Không có lỗi, không có cảnh báo, chỉ là một sự im lặng hoàn hảo, còn tệ hơn hỏng hóc vì trông như một cảm biến đang hoạt động nằm yên và phẳng. Việc đầu tiên của mọi trình điều khiển là ghi 0x00 vào thanh ghi 0x6B, và ví dụ in ra việc đó có thành công không.

Chip mô phỏng cũng khởi động ở trạng thái ngủ, nên quên bước này sẽ cho cùng các số không đứng yên ở đây như trên bàn thí nghiệm thật.

Đánh thức nó bằng các lệnh Wire thông thường
#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();
}

Biển trọng lực thành góc

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.

Ví dụ đọc cả mười bốn byte dữ liệu trong một lần, đổi các số thô sang phần nghìn g, và tính roll từ Y và Z, pitch từ X và Z. Arctang lấy từ một bảng tra chính xác đến khoảng một độ, nhanh và gọn hơn trên Uno so với atan2() của thư viện toán, dù atan2() cũng dùng được. Quá 12 độ về hai phía, một trong hai đèn ngoài thay thế đèn xanh lá.

Con quay hồi chuyển đo một thứ khác: tốc độ bo mạch đang xoay, theo độ mỗi giây, chứ không phải nó đang chỉ hướng nào. Nó đứng gần không khi bo mạch nằm yên và chỉ di chuyển khi bạn đang nghiêng nó.

WHO_AM_I và địa chỉ

Địa chỉ của chip là 0x68, hoặc 0x69 khi chân AD0 được kéo lên mức cao. Thanh ghi WHO_AM_I trả về 0x68 trong cả hai trường hợp, vì nó chứa các bit địa chỉ không gồm AD0. Vì vậy, driver so sánh WHO_AM_I với địa chỉ đang dùng sẽ hỏng đúng trên bo mạch mà ai đó đã nối thành 0x69. Ví dụ in ra cả hai để thấy sự khác biệt.

Thử trong trình soạn thảo

Mở mạch trong trình soạn thảo và kéo bo mạch cảm biến để nghiêng từ từ qua 12 độ. Đèn xanh lá chuyển sang đỏ hoặc xanh dương. Đổi FLAT_DEGREES thành 3 thì đồng hồ thành một mức nước nhạy quá mức; đổi thành 30 thì nó chỉ phàn nàn khi thực sự nghiêng.

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.

Sau đó tự viết vài dòng với Wire.h: một lần truyền tới 0x68 với thanh ghi 0x75, WHO_AM_I, và một lần đọc một byte. Nó in ra 68, giống hệt chip thật.

Những lỗi thường gặp

Forgetting to wake it, and getting zeros.

Đọc từng thanh ghi một. Sáu byte gia tốc có thể thay đổi giữa hai lần đọc riêng biệt, tạo ra một giá trị gồm nửa mẫu này và nửa mẫu kế tiếp. Hãy đọc cả khối trong một lần truyền.

Kỳ vọng có góc chỉ từ gyro. Tích phân độ trên giây theo thời gian sẽ trôi dần. Các dự án thật kết hợp gia tốc kế và gyro với bộ lọc complementary hoặc Kalman.

Kỳ vọng con số hoàn hảo từ phần cứng thật. Một MPU6050 thật có độ lệch trên mọi trục cho đến khi được hiệu chuẩn. Cái mô phỏng đọc sạch sẽ, điều này hữu ích để học phần toán và dễ chịu hơn bàn thí nghiệm.

Mở mạch này trong trình soạn thảo. Arduino Uno: đồng hồ đo nghiêng MPU6050, nối dây như đang chạy ở đầu trang này. Thay đổi một linh kiện hoặc một giá trị rồi chạy lại.

Mở mạch

Câu hỏi

Tôi có cần thư viện cho MPU6050 không?

Không. Wire.h biên dịch được ở đây nguyên trạng, và việc đánh thức rồi đọc chip chỉ là vài lần ghi thanh ghi và một lần đọc liên tục. Ví dụ dùng helper MPU6050 của riêng Mokxi, cái bọc đúng những việc đó.

Tôi có thể dùng MPU6050 với ESP32 không?

Có. Chip chạy ở 3.3 volt và các lần đọc thanh ghi tương tự hoạt động trên các chân I2C của ESP32.

Trình mô phỏng có DMP không?

Không. Bộ xử lý chuyển động bên trong chip thật, cái chạy firmware hòa trộn riêng, không được mô phỏng. Các thanh ghi gia tốc kế, gyro và nhiệt độ thô thì có.

Lắp mạch này ngoài đời

Mở trình soạn thảo, đổi một giá trị và xem con số thay đổi theo. Không cần cài gì, không cần tài khoản.