STM32F103C8驱动MPU6050姿态与tofsense报警 （六）

主函数

int main(void) 
{    
    //RCC_Configuration(); //时钟设置
    
    //BUZZER_BEEP1();//蜂鸣器音1
        //BUZZER_BEEP1();//蜂鸣器音1
    //delay_ms(50);
    SYS_Init();//系统初始化总函数
    while(1)   //主循环
    {
     // BUZZER_BEEP1();//蜂鸣器音1
        MPU_Read();    //MPU6050数据读取
        DATA_Report(); //MPU6050数据上报
    }
}
/**
  * @brief  系统初始化总函数
  * @param  无
  * @retval 无
  */
void SYS_Init(void)
{
    NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);  //中断优先级分组函数
    delay_init();                                     //延时函数初始化      
    uart_init(115200);                                  //串口初始化为115200
    LED_Init();                                            //初始化与LED连接的硬件接口
    BUZZER_Init();//蜂鸣器初始化
    
    MPU_Init();                                         //初始化MPU6050
    while(mpu_dmp_init())                            //初始化mpu_dmp库
     {
        LED1 = !LED1;delay_ms(50);LED1 = !LED1;     //LED闪烁指示
        printf("Initialization failed！\r\n");        //串口初始化失败上报
    }
    printf("Initialization succeed！\r\n");            //串口初始化成功上报