我就想判断俯仰角是否小于-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);
}
一周热门 更多>