舵机的控制 .c

关于舵机的一些程序

#include<SST89x5x4.H>
#include <math.h>
#define uchar unsigned char    
#define uint unsigned int
#define nint signed int
uchar code disptable[]={0x3F,0x06,0x5B,0x4F,0x66,0x6D,0x7D,0x07,0x7F, 0x6F,0x00};//定义0到9十个数字。

sbit P10=P1^0;
sbit P11=P1^1;
sbit P12=P1^2;
sbit P13=P1^3;
sbit P16=P1^6;
 uint min1,min2,sed1,sed2;
  uchar  min,sed;
  nint num=0,time=0; 

void delay(uchar x)
  {
   uchar y;
   while(x-->0)
    {
      for(y=0;y<125;y--)
      {;}
     }
   }
 void disp(void)
  {
    P0=disptable[min1];
    P10=1;
    delay(5);
    P10=0;
    P0=disptable[min2];
    P11=1;
    delay(5);
    P11=0;
    P0=disptable[sed1];
    P12=1;
    delay(5);
    P12=0;
    P0=disptable[sed2];
    P13=1; 
    delay(5);
    P13=0;                   
  }  

void clock_initial()  reentrant using 0
  {
   TCON=0X00;        
       TH0=(65536-50000)/256;
       TL0=(65536-50000)%256;    
       TR0=1;       
   }

 void main(void)
  { 
   	
    TMOD=0x01;	  					
    clock_initial();
    IT1=1;
    ET0=1;
    EA=1;
   while(1)
    { 
      min=num/60;
      sed=num%60;
      min1=min/10;
      min2=min%10;
      sed1=sed/10;
      sed2=sed%10;
      disp();
    if(num%2==0)
      {P16=1;}
    if(num%5==0)
       {P16=0;}
     }
 }
  
 void clock_int (void)	interrupt 1 using 0
   {
     if(++time==20)
     {num++;
     time=0;  
     }
      
  }