Sheila Pham
Added for gyro and testing
Diff: main.cpp
- Revision:
- 12:6efce6d008f8
- Child:
- 13:d66766523196
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Wed Jul 03 17:56:22 2019 +0000
@@ -0,0 +1,17 @@
+#include <MPU6050.h>
+#include "IMU6050.h"
+MPU6050 IMU(D14, D15);
+Serial pc(USBTX, USBRX, 57600); //Serial Monitor
+float dataA[3];
+float* data = dataA;
+int main()
+{
+ IMU.setGyroRange(MPU6050_GYRO_RANGE_500);
+ pc.printf("Imu test connections %d\r\n", IMU.testConnection());
+ while(1){
+
+ IMU.getGyro(data);
+ pc.printf("x: %f, y: %f, z: %f\r\n", dataA[0]*180/3.14, dataA[1]*180/3.14, dataA[2]*180/3.14);
+ wait(.2);
+ }
+}