中级会员
 
- 积分
- 342
- 金钱
- 342
- 注册时间
- 2014-11-13
- 在线时间
- 20 小时
|

楼主 |
发表于 2015-5-27 19:56:18
|
显示全部楼层
void SYS_Test(void)
{
float roll,pitch,yaw;
u8 data=0;
uart_init(9600);//????????????????
Sys_TIMConfig();
while(MPU_Init())
{
USART_SendString(USART1,"MPU Initial Error!\n");
}
Timerx_Init();
EN=0;
TIM_Cmd(TIM2,ENABLE);//????PWM?¨?±?÷
PWM_Motor(300,300);
EN=1;
Balance_LedInit();
LED_0=0;
LED_1=0;
LED_2=0;
LED_3=0;
delay_ms(500);
while(mpu_dmp_init())
{
//printf("MPU Error!\n");//?¨???????????à?????í?ó????
USART_SendString(USART1,"MPU Error!\n");
data=(u8)(mpu_dmp_init()+0x30);
USART_SendString(USART1,&data);
}
while(1)
{
mpu_dmp_get_data(&pitch,&roll,&yaw);
printf("pitch:%f\nroll:%f\nyaw:%f\n",pitch,roll,yaw);
}
} |
|