Sakai Ritaro
/
MPU6050_test
MPU6050 library test
main.cpp@2:6e9393d9cc11, 2019-08-15 (annotated)
- Committer:
- ritarosakai
- Date:
- Thu Aug 15 03:42:49 2019 +0000
- Revision:
- 2:6e9393d9cc11
- Parent:
- 1:01af59327884
Fix doxygen
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
ritarosakai | 0:5efae55d7fbb | 1 | #include "mbed.h" |
ritarosakai | 0:5efae55d7fbb | 2 | #include "MPU6050.h" |
ritarosakai | 0:5efae55d7fbb | 3 | |
ritarosakai | 2:6e9393d9cc11 | 4 | MPU6050 mpu(D4,D5); |
ritarosakai | 0:5efae55d7fbb | 5 | Serial pc(USBTX,USBRX); |
ritarosakai | 0:5efae55d7fbb | 6 | |
ritarosakai | 0:5efae55d7fbb | 7 | float gx,gy,gz,ax,ay,az; |
ritarosakai | 0:5efae55d7fbb | 8 | |
ritarosakai | 0:5efae55d7fbb | 9 | int main() |
ritarosakai | 0:5efae55d7fbb | 10 | { |
ritarosakai | 0:5efae55d7fbb | 11 | pc.baud(115200); |
ritarosakai | 0:5efae55d7fbb | 12 | if(mpu.getID()==0x68) { |
ritarosakai | 0:5efae55d7fbb | 13 | pc.printf("MPU6050 OK"); |
ritarosakai | 0:5efae55d7fbb | 14 | wait(1); |
ritarosakai | 0:5efae55d7fbb | 15 | } else { |
ritarosakai | 0:5efae55d7fbb | 16 | pc.printf("MPU6050 error ID=0x%x\r\n",mpu.getID()); |
ritarosakai | 0:5efae55d7fbb | 17 | while(1) { |
ritarosakai | 0:5efae55d7fbb | 18 | } |
ritarosakai | 0:5efae55d7fbb | 19 | } |
ritarosakai | 0:5efae55d7fbb | 20 | mpu.start(); |
ritarosakai | 0:5efae55d7fbb | 21 | while(1) { |
ritarosakai | 0:5efae55d7fbb | 22 | mpu.read(&gx,&gy,&gz,&ax,&ay,&az); |
ritarosakai | 0:5efae55d7fbb | 23 | pc.printf("gx,gy,gz,ax,ay,az %.1f,%.1f,%.1f,%.2f,%.2f,%.2f\r\n",gx,gy,gz,ax,ay,az); |
ritarosakai | 0:5efae55d7fbb | 24 | wait(0.1); |
ritarosakai | 0:5efae55d7fbb | 25 | } |
ritarosakai | 1:01af59327884 | 26 | } |