Chen Huan
平衡车的MPU6050驱动 C.H.
Fork of
MPU6050_Driver_Balance
by 
Chen Huan
Diff: main.cpp
- Revision:
- 0:badebd32bd8b
- Child:
- 1:588d4df02e56
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Mon Apr 09 14:34:45 2018 +0000
@@ -0,0 +1,25 @@
+#include "mbed.h"
+#include "mpu6050.h"
+
+
+DigitalOut myled(LED1);
+Serial pc(SERIAL_TX, SERIAL_RX);
+
+int main() {
+ float pitch,roll,yaw; //欧拉角
+
+ MPU_Init(); //初始化MPU6050
+ myled = 0;
+ while(mpu_dmp_init())
+ {
+ wait(0.2);
+ myled = !myled;
+ }
+ while(1)
+ {
+ if(mpu_dmp_get_data(&pitch,&roll,&yaw)==0)//获取欧拉角
+ {
+ pc.printf("pitch: %.2f roll: %.2f yaw: %.2f\r\n", pitch,roll,yaw);
+ }
+ }
+}