stm32 mpu6050驅(qū)動(dòng)代碼，數(shù)碼管顯示角度

ID:170209 · 發(fā)表于 2017-3-13 11:13

stm32mpu6050驅(qū)動(dòng)代碼，數(shù)碼管顯示角度。程序使用了dmp，且自動(dòng)校準(zhǔn)，用數(shù)碼管顯示一個(gè)方向的角度，其余方向也全讀出來了，在代碼里有

這文件是一些必要的資料

這是源代碼：

完整源碼下載：

角度儀—數(shù)碼管.rar (10.55 MB, 下載次數(shù): 85)

主程序預(yù)覽（完整代碼請(qǐng)下載附件）：

#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(); //系統(tǒng)時(shí)鐘等初始化
delay_init(72); //延時(shí)初始化
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初始化,關(guān)閉去除偏移量，自動(dòng)水平校準(zhǔn)
NVIC_Configuration(); //設(shè)置NVIC中斷分組2:2位搶占優(yōu)先級(jí)，2位響應(yīng)優(yōu)先級(jí)
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);
}