软驱步进电机测试程序

2012-05-28 21:22:20  阅读 4541 次 评论 0 条

N年前自己写的一个测试程序 用于3.5软驱的 那个小小步进电机驱动

#include <reg51.h>
#include <intrins.h>
//亮灯测试程序
char np;
char motortb[]={0x11,0x99,0x88,0xcc,0x44,0x66,0x22,0x33};//步进电机运行数据表

void delay(char t)// 每步延时的子程序
{
char i;
int j;
for (i=0;i<t;i++)
for (j=0;j<900;j++);
}

void a_step(char d,char t) //步进电机走一步d=0 正转d=1 反转, t 越大走得越慢                            
{
if (d&0x01)
{
if (np==0)
np=7;
else np--;
}
else
{
if (np==7)
np=0;
else np++;
}
P0=motortb[np];
delay(t);
}

void a_turn(char d,char t)// 步进电机走一圈
{
char i;
for (i=0;i<96;i++)
a_step(d,t);
}

void main(void)
{
P1=0xff;
P0=0x44;
np=4;
while (1)
a_turn(1,15);//转速可以在5-25左右的范围内调节,t太小则嗡嗡作响,转不起来
}
 

之二这个写的直接一点

 

#include <reg51.h>
 
//亮灯测试程序  串口发送数据
sbit     L1 =  P0^0;   //对应L1LED
sbit     L2 =  P0^1;      //对应L2LED
sbit     L3 =  P0^2;     //对应L3LED
sbit     L4 =  P0^3;     //对应L3LED

/*********************************************************
   500ms延时函数
   晶振:11.0592MHz
*********************************************************/
void delay(unsigned int j)
{
   unsigned char k;
   for(;j>0;j--)
  {
       for(k=180;k>0;k--);
   }
}

main()
{
  P0=0xff;


 
  while(1)
  {   
   L1=0;                  
     L2=0;
  L3=1;
  L4=1;
     delay(5);
  L1=1;                  
     L2=0;
  L3=0;
  L4=1;
     delay(5);
  L1=1;                  
     L2=1;
  L3=0;
  L4=0;
     delay(5);
  L1=0;                  
     L2=1;
  L3=1;
  L4=0;
     delay(5);

  
  }

}
 

 

本文地址:http://financialos.cn/?id=41
免责声明:本文为原创文章,版权归 jinesc 所有,欢迎分享本文,转载请保留出处!

发表评论


表情

还没有留言,还不快点抢沙发?