MPU6050 Accelerometer + Gyro เซนเซอร์วัดความเร่ง และ การเอียง SNP-00129

1#include "I2Cdev.h"
2
3#include "MPU6050.h"
4
5#include "Wire.h"
6
7MPU6050 mpu;
8
9int16_t ax, ay, az;
10
11int16_t gx, gy, gz;
12
13int valx , valy , valz;
14
15char rd;
16
17int prevVal;
18
19int led = 13 ;
20
21int pin11 = 11 , pin10 = 10 ;
22
23int val1 , val2 ;
24
25int valgy1 = 0 , valgy2 = 0;
26
27void setup() 
28
29{
30
31pinMode(led,OUTPUT) ;
32
33Wire.begin();
34
35Serial.begin(38400);
36
37Serial.println("Initialize MPU");
38
39mpu.initialize();
40
41Serial.println(mpu.testConnection() ? "Connected" : "Connection failed");
42
43}
44
45void loop() 
46
47{
48
49mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
50
51valx = map(ax, -17000, 17000, 0, 179);
52
53valy = map(ay, -17000, 17000, 0, 179);
54
55valz = map(az, -17000, 17000, 0, 179);
56
57Serial.print("axis x = ") ; 
58
59Serial.print(valx) ; 
60
61Serial.print(" axis y = ") ; 
62
63Serial.print(valy) ; 
64
65Serial.print(" axis z = ") ; 
66
67Serial.println(valz) ; 
68
69delay(100);
70
71}