stm32mpu6050驅動代碼，數碼管顯示角度。程序使用了dmp，且自動校準，用數碼管顯示一個方向的角度，其余方向也全讀出來了，在代碼里有
這文件是一些必要的資料
這是源代碼：
完整源碼下載：
角度儀—數碼管.rar
(10.55 MB, 下載次數: 85)
2017-3-13 11:13 上傳
點擊文件名下載附件
主程序預覽（完整代碼請下載附件）：
- #include "led.h"
- #include "delay.h"
- #include "sys.h"
- #include "usart.h"
- #include "lcd.h"
- #include "anbt_dmp_fun.h"
- #include "anbt_i2c.h"
- #include "anbt_dmp_mpu6050.h"
- #include "anbt_dmp_driver.h"
- #include "LED_NUM.h"
- void uart_send_status(float Pitch,float Roll,float Yaw) ;
- u16 count=10000;
- u8 get_pose_flag = 0;
- extern u8 LED[4];
-
- int main(void)
- {
- SystemInit(); //系統時鐘等初始化
- delay_init(72); //延時初始化
- uart_init(115200); //串口初始化為115200
- LCD_Init();
- LCD_Clear(BLUE);
- BACK_COLOR=BLUE;
- POINT_COLOR=YELLOW;
- LCD_ShowString(24,24,64,16,16,"X_ANGLE:");
- LCD_ShowString(24,48,64,16,16,"Y_ANGLE:");
- LCD_ShowString(24,72,64,16,16,"Z_ANGLE:");
-
- POINT_COLOR=RED;
- LCD_WriteNUM_float(128,24,Pitch,16);
- LCD_WriteNUM_float(128,48,Roll,16);
- LCD_WriteNUM_float(128,72,Yaw,16);
- ANBT_I2C_Configuration(); //IIC初始化
- AnBT_DMP_MPU6050_Init(); //6050DMP初始化,關閉去除偏移量，自動水平校準
- NVIC_Configuration(); //設置NVIC中斷分組2:2位搶占優先級，2位響應優先級
- LED_NUM_Init();
- while(1)
- {
- POINT_COLOR=RED;
- LCD_WriteNUM_float(128,24,Pitch,16);
- LCD_WriteNUM_float(128,48,Roll,16);
- LCD_WriteNUM_float(128,72,Yaw,16);
- // printf(" %8f %8f %8f\n\r",Pitch, Roll, Yaw);
- UART1_Put_Char((int)(Pitch*10)%256);UART1_Put_Char((int)(Pitch*10)/256);
- UART1_Put_Char((int)(Roll*10)%256);UART1_Put_Char((int)(Roll*10)/256);
- UART1_Put_Char((int)(Yaw*10)%256);UART1_Put_Char((int)(Yaw*10)/256);
- }
- }
- void EXTI1_IRQHandler(void)
- {
- if(EXTI_GetITStatus(EXTI_Line1) != RESET)
- {
- MPU6050_Pose();
- LED_NUM_Display();
- }
- EXTI_ClearITPendingBit(EXTI_Line1);
- }
|
