ctrl.c

利用winavr 编写的舵机控制程序

#include<common.h>
#include"delay.c"
#include"init.c"
#define DL 500
#define DR 1
void delay_1ms(void);
void ctrl(uint cf, uint n)
{
  uint i;
  uchar j=0x01;
  if(cf==0)
    for(i=0;i<n;i++)
	{
          DDRD=j;
      delay_1ms();//delay_1ms
      j=j<<1;
      if((j^0x08)==0) j=0x01;
    }
  else
    {
      for(i=0;i<n;i++)
        {
           DDRD=j;
           delay_nms(DL);
           j=j>>1;
           if(j==0) 
		   j=0x04;
         }
     }
}
void main(void)
  {
    InitIo();
    if(DR==1) ctrl(1,100);
    else ctrl(0,100);
	//return 1;
  }