สอนใช้งาน GY-521 IMU 3-axis Accelerometer/Gyro Module (MPU6050) กับ arduino
ตัวอย่างการใช้งาน
MPU6050 -> Arduino
Vcc -> 5V
GND -> GND
SCL -> A5
SDA -> A4
ตัวอย่าง Code
#include "I2Cdev.h"
#include "MPU6050.h"
#include "Wire.h"
MPU6050 mpu;
int16_t ax, ay, az;
int16_t gx, gy, gz;
int valx , valy , valz;
char rd;
int prevVal;
int led = 13 ;
int pin11 = 11 , pin10 = 10 ;
int val1 , val2 ;
int valgy1 = 0 , valgy2 = 0;
void setup()
{
pinMode(led,OUTPUT) ;
Wire.begin();
Serial.begin(38400);
Serial.println("Initialize MPU");
mpu.initialize();
Serial.println(mpu.testConnection() ? "Connected" : "Connection failed");
}
void loop()
{
mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
valx = map(ax, -17000, 17000, 0, 179);
valy = map(ay, -17000, 17000, 0, 179);
valz = map(az, -17000, 17000, 0, 179);
Serial.print("axis x = ") ;
Serial.print(valx) ;
Serial.print(" axis y = ") ;
Serial.print(valy) ;
Serial.print(" axis z = ") ;
Serial.println(valz) ;
delay(100);
}
ไม่มีความคิดเห็น:
แสดงความคิดเห็น