Bài học và trò chơi học tập

Gia tốc kế, gyro và IMU

Cảm biến chuyển động thực sự đo cái gì, biến thành độ nghiêng, hướng, số bước và các cú chạm, kết thúc bằng một thước thủy và một la bàn giữ đúng hướng cả khi bạn nghiêng nó.

Khóa học dạy gì

Gia tốc kế, gyro và IMU gồm bảy bài học trên Uno, chia thành bốn chương:

  • Hướng nào là xuống dưới: trọng lực như một vectơ trên MPU6050 đọc thẳng từ thanh ghi, số thô và dải đo, và góc nghiêng từ asin và atan2 trên một thủy cân ADXL345.
  • Quay và trôi: gyro cộng dồn thành một góc, độ trôi do offset của nó gây ra, hiệu chỉnh bỏ khi đứng yên, và bộ lọc bù với hằng số thời gian của nó.
  • Bắc, bước chân và cú chạm: la bàn từ kế, vì sao nghiêng đi là lệch tới hàng chục độ, độ lệch từ, và một máy đếm bước cùng bộ dò cú chạm dựng từ ngưỡng, trễ và thời gian.
  • Dự án tổng: một thước thủy bầu với LED xanh và đỏ cùng một la bàn bù nghiêng trên MPU-9250.

Mỗi chương kết thúc bằng một bài kiểm tra ngắn. Mở nó từ /learn.

Các mạch

Hai bài học mở các dự án trong thư viện: Thủy cân nghiêng (một ADXL345 trên bo GY-291) và Chín trục (một LSM6DSOX và một LIS3MDL trên cùng một bus I2C). Các bài còn lại chạy các sketch viết riêng cho khóa học, đều trên chân A4 và A5 của Uno:

sketch linh kiện tác dụng
imugravity MPU6050 ba trục theo đơn vị g, độ dài vectơ, số thô, một cú va đập gõ từ bàn phím
imugyro MPU6050 gyro cộng dồn đặt cạnh gia tốc kế, và cal để loại bỏ offset
imucomp MPU6050 một bộ lọc bù được chấm điểm so với số đo sạch, và một cú va đập gõ từ bàn phím
imustep ADXL345 máy đếm bước với nhịp bước, chạm đơn và chạm đôi
imuboss MPU-9250, hai LED mức thủy cân, các hướng la bàn và một heading bù nghiêng

Vì sao một số sketch thêm nhiễu

Các cảm biến mô phỏng hoàn hảo: không nhiễu, không offset, không trôi. Gyro của một MPU6050 thật đọc được vài phần tư của độ mỗi giây khi đứng yên, và gia tốc kế của nó rung nhẹ. Các bài về độ trôi và bộ lọc thêm những khuyết điểm đó vào sketch, với các con số ở đầu tệp (BIAS_DPS, NOISE_DPS, ACCEL_NOISE_G), nên những gì bạn thấy chính là những gì một bo mạch thật làm. Nhiễu được khởi tạo bằng hạt giống cố định, nên mỗi lần chạy cho cùng các con số.

Các gia tốc kế mô phỏng cũng chỉ cảm nhận trọng lực qua góc nghiêng, chứ không cảm nhận một cú đẩy. Máy đếm bước đi bằng cách dao động góc pitch, còn các lệnh va đập thêm cú đẩy bằng code.

Khắc phục sự cố

  • Mọi số đo đều bằng 0. MPU6050 khởi động ở chế độ ngủ. Sketch của nó ghi 0 vào thanh ghi 0x6B trước tiên; hãy giữ lại dòng đó.
  • Các số theo đơn vị g nhỏ hơn bốn lần. Dải đo trong thanh ghi 0x1C đã đổi mà hằng số counts-per-g thì chưa.
  • La bàn lệch hẳn. Nó đang bị nghiêng: công thức dùng khi phẳng chỉ đúng khi phẳng. Hãy dùng phần bù nghiêng của dự án tổng.
  • Không đếm được bước nào. Biên độ dao động phải vượt qua STEP_HIGH và quay về dưới STEP_LOW mỗi lần. Dao động mạnh hơn, hoặc hạ ngưỡng xuống.

The next course, Hợp nhất cảm biến và bộ lọc Kalman, chọn tỷ lệ trộn từ các số nhiễu và tự học offset của gyro trong lúc chạy.