Diff: main.cpp

Revision:

0:95e46ae24046

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri Oct 21 02:52:40 2016 +0000
@@ -0,0 +1,26 @@
+/// using NuMaker-PFM-NUC472 I2C0 to read 3-axis accelerometer & 3-axis gyroscope (MPU6500)
+#include "mbed.h"
+#include "mpu6500.h"
+
+I2C i2c0(PC_9, PA_15); // I2C0_SDA, I2C0_SCL
+
+MPU6500 IMU; // on-board IMU is MPU6500
+
+int main() {
+    int16_t accX,  accY,  accZ;
+    int16_t gyroX, gyroY, gyroZ;
+
+    i2c0.frequency(400000);    
+    IMU.initialize();
+    
+    while(true) {
+       accX = IMU.getAccelXvalue();
+       accY = IMU.getAccelYvalue();
+       accZ = IMU.getAccelZvalue();
+       gyroX= IMU.getGyroXvalue();
+       gyroY= IMU.getGyroYvalue();
+       gyroZ= IMU.getGyroZvalue();
+       printf("Acc: %6d, %6d, %6d, ",   accX, accY, accZ);
+       printf("Gyro:%6d, %6d, %6d\n\r", gyroX, gyroY, gyroZ);       
+    }
+}