Moto Sbk
/
mpu6050_test
mup6050 test for wallbot ble(led)
Fork of mpu6050_test by
main.cpp@1:4fb56c1cfd3d, 2018-04-23 (annotated)
- Committer:
- c201075
- Date:
- Mon Apr 23 07:05:08 2018 +0000
- Revision:
- 1:4fb56c1cfd3d
- Parent:
- 0:84dda456d02c
first commit
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" |
c201075 | 1:4fb56c1cfd3d | 3 | #define MPU6050_ADDRESS 0x68 |
garfieldsg | 0:84dda456d02c | 4 | |
garfieldsg | 0:84dda456d02c | 5 | DigitalOut myled(LED1); |
garfieldsg | 0:84dda456d02c | 6 | Serial pc(USBTX, USBRX); |
c201075 | 1:4fb56c1cfd3d | 7 | MPU6050 mpu(I2C_SDA,I2C_SCL); |
garfieldsg | 0:84dda456d02c | 8 | |
garfieldsg | 0:84dda456d02c | 9 | int main() |
garfieldsg | 0:84dda456d02c | 10 | { |
garfieldsg | 0:84dda456d02c | 11 | |
c201075 | 1:4fb56c1cfd3d | 12 | float a[3]; |
c201075 | 1:4fb56c1cfd3d | 13 | float g[3]; |
c201075 | 1:4fb56c1cfd3d | 14 | mpu.setAcceleroRange(0); |
c201075 | 1:4fb56c1cfd3d | 15 | mpu.setGyroRange(0); |
c201075 | 1:4fb56c1cfd3d | 16 | |
garfieldsg | 0:84dda456d02c | 17 | while(1) { |
c201075 | 1:4fb56c1cfd3d | 18 | myled = 1; |
c201075 | 1:4fb56c1cfd3d | 19 | wait(0.1); |
c201075 | 1:4fb56c1cfd3d | 20 | myled = 0; |
c201075 | 1:4fb56c1cfd3d | 21 | wait(0.1); |
c201075 | 1:4fb56c1cfd3d | 22 | mpu.getAccelero(a); |
c201075 | 1:4fb56c1cfd3d | 23 | mpu.getGyro(g); |
c201075 | 1:4fb56c1cfd3d | 24 | pc.printf("%4.3f,%4.3f,%4.3f,%4.3f,%4.3f,%4.3f\r\n",a[0],a[1],a[2],g[0],g[1],g[2]); |
garfieldsg | 0:84dda456d02c | 25 | } |
garfieldsg | 0:84dda456d02c | 26 | } |