Lập trình đo độ nghiêng
Viết
chương trình: https://wokwi.com/projects/380445044162963457
Thông
tin về cảm biến: https://docs.wokwi.com/parts/wokwi-mpu6050
Bài viết:
https://lastminuteengineers.com/mpu6050-accel-gyro-arduino-tutorial/
Lập trình đo độ nghiêng 3 trục X,
Y, Z hiển thị trên máy tính
Kiến thức lý thuyết:
Cảm biến độ nghiêng 3 trục MPU6050:
- Giao tiếp I2C: địa chỉ 0x68
– Đo độ nghiêng 3 trục: X, Y, Z
- Các chân sử dụng: VCC, GND, SDA, SCL
Kết nối phần cứng: Sử dụng 1 bus dây 4 kết nối mô đun trung tâm với mô
đun 5 theo sơ đồ sau:
Chương trình hoàn thiện:
Cài đặt thư viện MPU6050_light
#include "Wire.h"
#include <MPU6050_light.h>
MPU6050 mpu(Wire);
unsigned long timer = 0;
void setup()
{
Serial.begin(9600);
Wire.begin();
byte status = mpu.begin();
Serial.print(F("MPU6050
status: "));
Serial.println(status);
while(status!=0){ }
Serial.println(F("Calculating offsets, do
not move MPU6050"));
delay(1000);
mpu.calcOffsets();
Serial.println("Done!\n");
}
void loop()
{
mpu.update();
if((millis()-timer)>10)
{
Serial.print("X : ");
Serial.print(mpu.getAngleX());
Serial.print("\tY : ");
Serial.print(mpu.getAngleY());
Serial.print("\tZ : ");
Serial.println(mpu.getAngleZ());
timer = millis();
}
}
Bài tập áp dụng:
Bài 1: Lập trình đo độ nghiêng 3 trục X, Y, Z hiển thị trên LCD
Bài 2: Lập trình đo độ nghiêng 3 trục X, Y hiển thị trên LCD và hiển thị
cảnh báo khi trục
X>60 độ và X <-60 độ
Không có nhận xét nào:
Đăng nhận xét