ISISA-Zacatenco
/
mpu6050_lk25_test
test kl25 mpu6050
main.cpp@1:9ab6fa1b0541, 2019-11-19 (annotated)
- Committer:
- Javierdf
- Date:
- Tue Nov 19 05:13:47 2019 +0000
- Revision:
- 1:9ab6fa1b0541
- Parent:
- 0:84dda456d02c
mpu6050 test kl25
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
garfieldsg | 0:84dda456d02c | 1 | #include "mbed.h" |
garfieldsg | 0:84dda456d02c | 2 | #include "MPU6050.h" |
Javierdf | 1:9ab6fa1b0541 | 3 | //#include "device.h" |
garfieldsg | 0:84dda456d02c | 4 | |
garfieldsg | 0:84dda456d02c | 5 | DigitalOut myled(LED1); |
garfieldsg | 0:84dda456d02c | 6 | Serial pc(USBTX, USBRX); |
garfieldsg | 0:84dda456d02c | 7 | MPU6050 mpu; |
garfieldsg | 0:84dda456d02c | 8 | |
garfieldsg | 0:84dda456d02c | 9 | int16_t ax, ay, az; |
garfieldsg | 0:84dda456d02c | 10 | int16_t gx, gy, gz; |
garfieldsg | 0:84dda456d02c | 11 | |
garfieldsg | 0:84dda456d02c | 12 | int main() |
garfieldsg | 0:84dda456d02c | 13 | { |
garfieldsg | 0:84dda456d02c | 14 | pc.printf("MPU6050 test\n\n"); |
garfieldsg | 0:84dda456d02c | 15 | pc.printf("MPU6050 initialize \n"); |
garfieldsg | 0:84dda456d02c | 16 | |
garfieldsg | 0:84dda456d02c | 17 | mpu.initialize(); |
garfieldsg | 0:84dda456d02c | 18 | pc.printf("MPU6050 testConnection \n"); |
garfieldsg | 0:84dda456d02c | 19 | |
garfieldsg | 0:84dda456d02c | 20 | bool mpu6050TestResult = mpu.testConnection(); |
garfieldsg | 0:84dda456d02c | 21 | if(mpu6050TestResult) { |
garfieldsg | 0:84dda456d02c | 22 | pc.printf("MPU6050 test passed \n"); |
garfieldsg | 0:84dda456d02c | 23 | } else { |
garfieldsg | 0:84dda456d02c | 24 | pc.printf("MPU6050 test failed \n"); |
garfieldsg | 0:84dda456d02c | 25 | } |
garfieldsg | 0:84dda456d02c | 26 | |
garfieldsg | 0:84dda456d02c | 27 | while(1) { |
garfieldsg | 0:84dda456d02c | 28 | wait(1); |
garfieldsg | 0:84dda456d02c | 29 | mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz); |
garfieldsg | 0:84dda456d02c | 30 | //writing current accelerometer and gyro position |
garfieldsg | 0:84dda456d02c | 31 | pc.printf("%d;%d;%d;%d;%d;%d\n",ax,ay,az,gx,gy,gz); |
garfieldsg | 0:84dda456d02c | 32 | } |
garfieldsg | 0:84dda456d02c | 33 | } |