舵机.c

船模型控制程序带舵机控制

/*-----------------------------------------

-----------------------------------------*/
#include <REG2051.H>
#define  uchar unsigned char
#define  uint  unsigned int
/*--------------------------------*/
sbit K1=P3^0;            
sbit K2=P3^1;     

sbit K3=P3^2;            
sbit K4=P3^3; 

sbit K5=P3^4;            
sbit K6=P3^5; 
       

sbit dj=P1^7;    
sbit dj1=P1^6; 

sbit dj2=P1^1;    
sbit dj3=P1^4; 

sbit dj4=P1^3;    
sbit dj5=P1^2; 
/*-----------------------------
void delay1(uint ms)
{
uint i;
for(i=0;i<ms;i++);            //Feed the dog
}
//-----------------------------*/
void delay(uint ms)
{
uint i;
for(i=0;i<ms;i++);
//delay1(1000);            //Feed the dog
}
//-----------舵机---------------
void Show0(void)
{ 
 if(K1==1)
   {
   dj=0;dj1=1;
   delay(800);
   dj=0;dj1=0;
   //while(K1);
   }
 if(K2==1)
   {
   dj1=0;dj=1;
   delay(800);
   dj1=0;dj=0;
   //while(K2);
   }
}
//-----------主机控制-------------
void Show1(void)
{ 
 if(K3==1)
   {
   dj2=0;dj3=1;
   delay(800);
   }
else if(K4==1)
     {
     dj3=0;dj2=1;
     delay(800);
	 }
else {dj2=1;dj3=1;}
}
//-----------水枪控制-------------
void Show2(void)
{ 
 if(K5==1)
   {
   dj4=0;dj5=1;
   delay(800);
   }
else if(K6==1)
     {
     dj5=0;dj4=1;
     delay(800);
	 }
else {dj4=1;dj5=1;}
}
//-----------------------------
void main(void)
{
dj1=dj=0;
while(1)
  {
   Show0();
   Show1();
   Show2();
  }
}