- #include "delay.h"
 
 - #include "sys.h"
 
 - #include "usart.h"
 
 - #include "led.h"
 
 - #include "bluetooth.h"
 
 - #include "motor.h"
 
 - #include "speed.h"
 
 - #include "mp6050.h"
 
 - #include "key.h"
 
 - #include "ultrasonic.h"
 
 - #include "DataScope_DP.h"
 
 -  
 
 -  
 
 - int main(void)
 
 - {
 
 -         u8 i,Send_Count;
 
 -         
 
 -         delay_init(72);
 
 -         NVIC_Configuration();
 
 -         uart_init(9600);
 
 -         LED_Init();
 
 -         KEY_Init();
 
 -         BLUETOOTH_Init(9600);
 
 -         MPU6050_Init();
 
 -         PID_Init();
 
 -         ENCODER_Init();
 
 -         ULTRASONIC_Init();
 
 -         MOTOR_Init();
 
  
-   while (1)
 
 -   { 
 
 - //                DataScope_Get_Channel_Data( acc_x, 1 );  //上位机波形显示
 
 - //                DataScope_Get_Channel_Data( gyro_y, 2 );  
 
 - //                DataScope_Get_Channel_Data( angle_ax, 3 );   
 
 - //                DataScope_Get_Channel_Data( angle_gy , 4 );     
 
 - //                DataScope_Get_Channel_Data(angle, 5 );   
 
 - //                DataScope_Get_Channel_Data(Kp , 6 );  
 
 - //                DataScope_Get_Channel_Data(speed, 7 );  
 
 - //                DataScope_Get_Channel_Data( 0, 8 );   
 
 - //                DataScope_Get_Channel_Data(0, 9 );    
 
 - //                DataScope_Get_Channel_Data( 0 , 10);  
 
 - //                Send_Count = DataScope_Data_Generate(10);  
 
 - //                for( i = 0 ; i < Send_Count; i++)   
 
 - //                {  
 
 - //                        while((USART1->SR&0X40)==0);    
 
 - //                        USART1->DR = DataScope_OutPut_Buffer[i];   
 
 - //                }  
 
 - //                delay_ms(50); //20HZ         
 
 -                 
 
 -                 
 
 -                 ULTRASONIC_Distance();//600ms测距一次
 
 -                         //USART_ITConfig(USART3, USART_IT_TXE, ENABLE);//使能USART3发送中断
 
 -                 delay_ms(600);
 
 -   }
 
 - }
 
 
  问一下楼主,那个平衡直接在初始化函数里实现了吗? 
  |