วิธีวัดมุมด้วย MPU-6050(GY-521): 3 ขั้นตอน

2024 ผู้เขียน: John Day | [email protected]. แก้ไขล่าสุด: 2024-01-30 13:07

ในคำแนะนำนี้ เราจะวัดมุมด้วย Arduino เราต้องการสายเคเบิล Arduino UNO และ GY-521(MPU-6050) เพื่อวัดมุม

ขั้นตอนที่ 1: เชื่อมต่อ MPU-6050 กับ Arduino UNO

เราต้องการสายเคเบิลตัวผู้-ตัวเมีย เซ็นเซอร์ Arduino UNO และ GY-521(MPU-6050) เพื่อวัดมุม เราต้องต่อ MPU-6050 กับ Arduino UNO ตามที่แสดงในภาพ ดังนั้น,

• VCC ถึง 5V (MPU-6050 ใช้งานได้กับ 3.3V แต่ GY-521 เพิ่มขึ้นเป็น 5V)
• GND ถึง GND,
• SCL ถึง A5,
• SDA ถึง A4,
• ADO ถึง GND,
• INT เป็นพินดิจิตอล 2

ขั้นตอนที่ 2: รหัส

นี่คือรหัส มันใช้ I2C ฉันเอารหัสบางส่วนจากอินเทอร์เน็ต (ส่วน I2C)

//เขียนโดย Ahmet Burkay KIRNIK//การวัดมุมด้วย MPU-6050(GY-521)

#รวม

const int MPU_addr=0x68; int16_t AcX, AcY, AcZ, Tmp, GyX, GyY, GyZ;

int minVal=265; int maxVal=402;

สองเท่า x; สองเท่า y; ดับเบิ้ลซี;

การตั้งค่าเป็นโมฆะ () { Wire.begin (); Wire.beginTransmission(MPU_addr); Wire.write(0x6B); Wire.write(0); Wire.endTransmission(จริง); Serial.begin(9600); } วงเป็นโมฆะ () { Wire.beginTransmission (MPU_addr); Wire.write(0x3B); Wire.endTransmission (เท็จ); Wire.requestFrom(MPU_addr, 14, จริง); AcX=Wire.read()<<8|Wire.read(); AcY=Wire.read()<<8|Wire.read(); AcZ=Wire.read()<<8|Wire.read(); int xAng = แผนที่ (AcX, minVal, maxVal, -90, 90); int yAng = แผนที่ (AcY, minVal, maxVal, -90, 90); int zAng = แผนที่ (AcZ, minVal, maxVal, -90, 90);

x= RAD_TO_DEG * (atan2(-yAng, -zAng)+PI); y= RAD_TO_DEG * (atan2(-xAng, -zAng)+PI); z= RAD_TO_DEG * (atan2(-yAng, -xAng)+PI);

Serial.print("มุมX= "); Serial.println(x);

Serial.print("มุมY= "); Serial.println(y);

Serial.print("มุมZ= "); Serial.println(z); Serial.println("-----------------------------------------"); ล่าช้า (400); }

ขั้นตอนที่ 3: เสร็จแล้ว

มันจบแล้ว! หากไม่ได้ผลหรือคุณต้องการความช่วยเหลือ โปรดแสดงความคิดเห็นหรือส่งอีเมล คุณสามารถหาที่อยู่อีเมลของฉันได้จากความคิดเห็น อีกอย่าง ภาษาอังกฤษของฉันไม่ค่อยดี ฉันขอโทษในภาษาอังกฤษที่ไม่ดีของฉัน

Ahmet Burkay KIRNIK

อิสตันบูลตุรกี

แก้ไข: หลังจาก 2 ปี ภาษาอังกฤษของฉันดีขึ้น ดังนั้นฉันจึงแก้ไขข้อผิดพลาดบางอย่าง