mpu_dmp_get_data(&pitch,&roll,&yaw)为什么返回值是2啊

2019-07-25 12:18发布

我就想判断俯仰角是否小于-2.5
int main(void)
{       
         float pitch,roll,yaw;                 //欧拉角
         delay_init();
         CAR_Init();
         PID_init();
         MPU_Init();
         mpu_dmp_init();
         TIM4_PMW_Init(20000-1,72-1,Angle_Zero);
         while(1)         
{
        mpu_dmp_get_data(&pitch,&roll,&yaw);
        if(pitch<(-2.5))
        {
          GPIO_ResetBits(GPIOC,GPIO_Pin_13);  //LED0对应引脚GPIOB.5拉低,亮  等同LED0=0;
           delay_ms(300);
           GPIO_SetBits(GPIOC,GPIO_Pin_13);   //LED1对应引脚GPIOE.5拉高,灭 等同LED1=1;
     delay_ms(300);
        }

0条回答

一周热门 更多>