Thứ Sáu, 3 tháng 11, 2023

Cảm biến độ nghiêng 3 trục MPU6050

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/

 LCD _i2c:LCD i2c:  https://wokwi.com/projects/344891772964438612

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