基于双核多接口的智能汽车控制系统设计

     void Gyro_Process(void)
     { 
       if(Gyro_Start == 1)
       { 
         unsigned int Max,Min,i,Value;
         signed long Sum;
         Gyro_Data_Num = 0;
         while(Gyro_Data_Num < 13)
         {
           Gyro_Collection();//AD转换后的数据采集函数
         }
         Gyro_Start = 0;
         for(i=1,Max=0,Min=0xffff,Sum
         =0;i<13;i++)
         {
           Value=Gyro_Data_BUF[i];
           Sum+=Value;
            if(Max                Max=Value;
            if(Min>Value)
               Min=Value;
         }
         Sum= Sum-Max-Min ;
         SUM_Test =  Sum;
         CarAngel_V=((((signed long)(Sum/10)- (signed long)Gyro_
            MidValue)*10000)>>16);
        /限幅处理/
         if(CarAngel_V > 0)
         {
           CarAngel_V = (CarAngel_V *
             1013) / 1000;
         }
         if(CarAngel_V<0)
         {
           CarAngel_V = (CarAngel_V *
           1004)/ 1000;
         }
         if(CarAngel_V>32767)
         {
           CarAngel_V=32767;
         }
         if(CarAngel_V<-32767)
         {
           CarAngel_V=-32767;
         }
         if(Gyro_Calibration_Flag == 1)
           CarAngelRate = (unsigned int)
              (CarAngel_V + 32767);
         else
           CarAngelRate = 32767;
        
       }
     }

　　TPM模块在伺服电机中的应用

　　MC9S08DZ60拥有8路独立的PWM通道，可以独立配置PWM的频率和占空比，最高频率为总线时钟频率20MHz，可以满足对舵机和电机的控制。同时此模块还有两路计数器模块，可以采集码盘返回的电机速度值，以便用于速度闭环控制。其中电机控制中的PWM初始化如下：