servomotor.c

使用MC9S12DG128芯片

#include "includes.h"

void Servo_Func(void) {

    INT8U LcdServo[] = {"LcdServo                                "};
          
    LcdWriteAll(LcdServo);

    InitPWM45();
    
    for(;;) {
      
      while (KeyFlag == ON) {
        
         KeyFlag = OFF;
        
        if (ValueKey == Enter){Servo2deg(-3000);} 
        
        else if (ValueKey == Exit) return;    //if have exit key,go back
        
       }
      
     }
  
}

void Servo2deg(INT16S Deg)     //左转为负，右转为正，带入角度值，例如舵机左转30.50度则带入-3050
{
                                //-3600 - 3600
  //StopPWM45();
  
  SetPWM45(60000,55500-Deg/3);
  
  StartPWM45();
}