角度舵机控制手爪开合测试程序

/*************************************************
程序名：  角度舵机控制手爪开合测试程序
说明：    角度舵机接P1_2         
MCU：   AT89S52                      
OSC:   11.0592MHz               
WDT：   Disable                      
编译软件： Keil uVison V4.00a           
编者：  荆轩道        
时间：  2012-12-17         
*************************************************/

//此程序测试电机型号 Futaba S3001  180度角度电机。

#include
#include

#define uint unsigned int
#define uchar unsigned char

sbit angle_motor = P1^2; 

/************************************************************************************
函数名：主函数
调  用：无
参  数：无
返回值：无
结  果：无
备  注：
/************************************************************************************/
void main()
{ 
 char x;
 while(1)
 {
  for(x = 0; x < 50; x ++)   // close
  {
   angle_motor =  1;
   delay_nus(1650);   // 闭合到夹住物块 1600~1700   
   angle_motor = 0;   
   delay_nms(20);
   }
    
  for(x = 0; x < 50; x ++)  // OPEN
  {
   angle_motor =  1;
   delay_nus(2200);   //开夹口到限位区 2000~2500    
   angle_motor = 0;   
   delay_nms(20);
  } 
 }
}