基于雙核多接口的智能汽車控制系統設計

     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初始化如下：