Norawit Nangsue
/
j_mpu6050
mpu6050
main.cpp@0:db87af04ff89, 2014-07-02 (annotated)
- Committer:
- oakx
- Date:
- Wed Jul 02 16:19:28 2014 +0000
- Revision:
- 0:db87af04ff89
hello
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
oakx | 0:db87af04ff89 | 1 | #include "mbed.h" |
oakx | 0:db87af04ff89 | 2 | #include "MPU6050.h" |
oakx | 0:db87af04ff89 | 3 | |
oakx | 0:db87af04ff89 | 4 | DigitalOut myled(LED1); |
oakx | 0:db87af04ff89 | 5 | Serial pc(USBTX, USBRX); |
oakx | 0:db87af04ff89 | 6 | MPU6050 mpu; |
oakx | 0:db87af04ff89 | 7 | |
oakx | 0:db87af04ff89 | 8 | int16_t ax, ay, az; |
oakx | 0:db87af04ff89 | 9 | int16_t gx, gy, gz; |
oakx | 0:db87af04ff89 | 10 | |
oakx | 0:db87af04ff89 | 11 | int main() |
oakx | 0:db87af04ff89 | 12 | { |
oakx | 0:db87af04ff89 | 13 | pc.baud(9600); |
oakx | 0:db87af04ff89 | 14 | pc.printf("MPU6050 test\n\n"); |
oakx | 0:db87af04ff89 | 15 | pc.printf("MPU6050 initialize \n"); |
oakx | 0:db87af04ff89 | 16 | |
oakx | 0:db87af04ff89 | 17 | mpu.initialize(); |
oakx | 0:db87af04ff89 | 18 | pc.printf("MPU6050 testConnection \n"); |
oakx | 0:db87af04ff89 | 19 | |
oakx | 0:db87af04ff89 | 20 | bool mpu6050TestResult = mpu.testConnection(); |
oakx | 0:db87af04ff89 | 21 | if(mpu6050TestResult) { |
oakx | 0:db87af04ff89 | 22 | pc.printf("MPU6050 test passed \n"); |
oakx | 0:db87af04ff89 | 23 | } else { |
oakx | 0:db87af04ff89 | 24 | pc.printf("MPU6050 test failed \n"); |
oakx | 0:db87af04ff89 | 25 | } |
oakx | 0:db87af04ff89 | 26 | |
oakx | 0:db87af04ff89 | 27 | while(1) { |
oakx | 0:db87af04ff89 | 28 | wait(1); |
oakx | 0:db87af04ff89 | 29 | mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz); |
oakx | 0:db87af04ff89 | 30 | //writing current accelerometer and gyro position |
oakx | 0:db87af04ff89 | 31 | pc.printf("ax = %d ,ay = %d ,az = %d , gx = %d, gy = %d, gz = %d\n",ax,ay,az,gx,gy,gz); |
oakx | 0:db87af04ff89 | 32 | } |
oakx | 0:db87af04ff89 | 33 | |
oakx | 0:db87af04ff89 | 34 | } |