#define uchar unsigned char
#define uint unsigned int
sbit KEY1 = P3^2 //步进电机逆时针方向转
sbit KEY2 = P3^3 //步进电机顺时针方向转
sbit KEY3 = P3^4//步进电机调速
uchar step = 0
bit AB_flag = 0
unsigned char code A_Rotation[8]={0x08,0x18,0x10,0x30,0x20,0x60,0x40,0x48} //顺时针转表格
unsigned char code B_Rotation[8]={0x48,0x40,0x60,0x20,0x30,0x10,0x18,0x08} //逆时针转表格
/********************************************************************
* 名称 : Delay_1ms()
* 功能 : 延时子程序,延时时间为 1ms * x
* 输入 : x (延时一毫秒的个数)
* 输出 : 无
***********************************************************************/
void Delay(uint i)
{
uchar x,j
for(j=0j<ij++)
for(x=0x<=148x++)
}
void KEY(void)
{
if(KEY1 == 0) //按P3.2,实现步进电机的逆时针转动
{
Delay(15)
if(KEY1 == 0)
{
while(1)
{
if(KEY1 == 1)
{
Delay(15)
if(KEY1 == 1)
{
AB_flag = 0
break
}
}
}
}
}
if(KEY2 == 0) //按P3.3,实现步进电机的顺时针转动
{
Delay(15)
if(KEY2 == 0)
{
while(1)
{
if(KEY2 == 1)
{
Delay(15)
if(KEY2 == 1)
{
AB_flag = 1
break
}
}
}
}
}
if(KEY3 == 0) //按P3.4,实现步进电机的调速
{
Delay(15)
if(KEY3 == 0)
{
while(1)
{
if(KEY3 == 1)
{
Delay(15)
if(KEY3 == 1)
{
step++
if(step == 3)
{
step = 0
}
break
}
}
}
}
}
}
main()
{
uchar i
while(1)
{
KEY() //按键处理函数
for(i=0i<8i++)//因为有8路的控制时序
{
if(AB_flag == 0)
{
P1 = A_Rotation[i] //逆时针转动
}
else
{
P1 = B_Rotation[i] //顺时针转动
}
Delay(2+step) //改变这个参数可以调整电机转速
}
}
}
不清楚您具体采用的什么控制器(PLC或是单片机)和什么步进电机。这里当着您使用的是单片机与5线4相电机
通常情况下控制单片机的4个IO口,使其都为高电平。
再按照一个方向轮流使其中一个IO口变为低电平(间隔这里先为2ms,修改间隔时间可以控制转速),就可以驱动步进电机转起。
#include<reg52.h>#include<intrins.h>
#define mode 0x81 // 方式0,A口、B口输出,C口高4位输出,低4位输入
# include "stdio.h"
# include "string.h"
# include "math.h"
xdata unsigned char PA _at_ 0x7f00
xdata unsigned char PB _at_ 0x7f01
xdata unsigned char PC _at_ 0x7f02
xdata unsigned char caas _at_ 0x7f03//控制字
sbit P32=P3^2
sbit P33=P3^3
sbit P35=P3^5
#define uchar unsigned char
#define uint unsigned int
unsigned char h,Pos
unsigned int R,NX,NY
unsigned char key
code unsigned char KeyTable[] = { // 键码定义
0x0f, 0x0b, 0x07, 0x03,
0x0e, 0x0a, 0x06, 0x02,
0x0d, 0x09, 0x05, 0x01,
0x0c, 0x08, 0x04, 0x00
}
code unsigned char LEDMAP[] = { // 八段管显示码
0x3f, 0x06, 0x5b, 0x4f, 0x66, 0x6d, 0x7d, 0x07,
0x7f, 0x6f, 0x77, 0x7c, 0x39, 0x5e, 0x79, 0x71
}
unsigned char Code_ // 字符代码寄存器
#define PD1 61 // 122/2 分成左右两半屏(122x32)
unsigned char Column
unsigned char Page_ // 页地址寄存器 D1,DO:页地址
unsigned char Code_ // 字符代码寄存器
unsigned char Command// 指令寄存器
unsigned char LCDData// 数据寄存器
xdata unsigned char CWADD1 _at_ 0x1cff// 写指令代码地址(E1)
xdata unsigned char DWADD1 _at_ 0x1eff// 写显示数据地址(E1)
xdata unsigned char CRADD1 _at_ 0x1dff// 读状态字地址(E1)
xdata unsigned char DRADD1 _at_ 0x1fff// 读显示数据地址(E1)
xdata unsigned char CWADD2 _at_ 0x3cff// 写指令代码地址(E2)
xdata unsigned char DWADD2 _at_ 0x3eff// 写显示数进地址(E2)
xdata unsigned char CRADD2 _at_ 0x3dff// 读状态字地址(E2)
xdata unsigned char DRADD2 _at_ 0x3fff// 读显示数据地址(E2)
//----------------------液晶-----------------
// 清屏
// ************************ 中文显示程序 ***********************************/
/*************************直线 插 补***************************8*/
void delay(uint z)
{
uint x,y
for(x=zx>0x--)
for(y=50y>0y--)
}
void zhengx()
{
PA=0x00
delay(10)
PA=0x01
delay(10)
}
void fux()
{
PA=0x02
delay(10)
PA=0x03
delay(10)
}
void zhengy()
{
PB=0x00
delay(10)
PB=0x10
delay(10)
}
void fuy()
{
PB=0x20
delay(10)
PB=0x30
delay(10)
}
void zhixian(int NX,int NY)
{int FM, NXY, XOY,ZF,z
FM=0
{if(NX>0)
if(NY>0)
XOY=1
else
XOY=4
else
if(NY>0)
XOY=2
else
XOY=3}
for(NXY= fabs(NX) + fabs(NY)-1NXY>=0&&P32!=0&&P33!=0NXY--)
{ {if(NX>0)
if(NY>0)
XOY=1
else
XOY=4
else
if(NY>0)
XOY=2
else
XOY=3}
for(NXY= fabs(NX) + fabs(NY)-1NXY>=0NXY--)
{ if(FM>=0)
{if(XOY==1||XOY==4)
{ZF=1
zhengx()
}
else
{ZF=2
fux()
}
FM=FM-fabs(NY)
}
else
{if(XOY==1||XOY==2)
{
ZF=3
zhengy()
}
else
{ZF=4
fuy()
}
FM=FM+fabs(NX)
}
}
for(z=0z<200z++)
{P35 = 0
delay(10)
P35 = 1
delay(10)
}
}
}
/*************************圆 弧 插 补***************************8*/
void yuanhu1( int X0,int Y0, int NX, int NY ,int RNS )
{
int NXY,BS,ZF,XM,YM,z
int FM=0
BS=fabs(NX-X0) + fabs(NY-Y0)
XM=fabs(X0)
YM=fabs(Y0)
for(NXY= fabs(NX-X0) + fabs(NY-Y0)-1NXY>=0&&P32!=0&&P33!=0NXY--)
{
if(RNS==1||RNS==3||RNS==6||RNS==8)
{
if(FM<0)
{
if(RNS==1||RNS==8)
{ZF=1
zhengx()
}
else
{ZF=2
fux()}
FM=FM+2*fabs(XM)+1
XM=XM+1
}
else
{
if(RNS==1||RNS==6)
{
ZF=3
fuy()
}
else
{ZF=4
zhengy()
}
FM=FM-2*fabs(YM)+1
YM=YM-1
}
}
else
if(FM>=0)
{
if(RNS==2||RNS==7)
{ZF=1
zhengx()
}
else
{ZF=2
fux()
}
FM=FM-2*fabs(XM)+1
XM=XM-1
}
else
{
if(RNS==2||RNS==5)
{ZF=3
zhengy()}
else
{ZF=4
fuy()}
FM=FM+2*fabs(YM)+1
YM=YM+1
}
}
if(P32==0||P33==0)
{
for(z=0z<200z++)
{P35 = 0
delay(10)
P35 = 1
delay(10)
}
}
}
int shuzhi1 ()
{
int i=0,j=0,k=3
while (1)
{
if(testkey())
{ delay(300)
delay1()
if(testkey())
{ j=getkey()
if(j!=14)
{i=i*10 + j
k--}
}}
if(k==0)
break
}
return i
}
int shuzhi2 ()
{
int i=0,j=0,k=3
while (1)
{
if(testkey())
{ delay(300)
delay1()
if(testkey())
{ j=getkey()
if(j!=14)
{i=i*10 + j
k--}
}}
if(k==0)
break
}
return i
}
void yuanhuchabu1()
{ int q=0
delay(300)
R=shuzhi1()
yj1()
q=R/100
Page_ = 0x00
Column = 0x35
Code_ = q
WriteCHN8x16()
q=R%100
q=q/10
Page_ = 0x00
Column = 0x40
Code_ = q
WriteCHN8x16()
q=R%10
Page_ = 0x00
Column = 0x48
Code_ = q
WriteCHN8x16()
yuanhu1(R,0,0,R,5)
yuanhu1(0,R,-R,0,6)
yuanhu1(-R,0,0,-R,7)
yuanhu1(0,-R,R,0,8)
}
void yuanhuchabu2()
{ int q=0
delay(300)
R=shuzhi1()
yj1()
q=R/100
Page_ = 0x00
Column = 0x35
Code_ = q
WriteCHN8x16()
q=R%100
q=q/10
Page_ = 0x00
Column = 0x40
Code_ = q
WriteCHN8x16()
q=R%10
Page_ = 0x00
Column = 0x48
Code_ = q
WriteCHN8x16()
yuanhu1(0,R,R,0,1)
yuanhu1(R,0,0,-R,4)
yuanhu1(0,-R,-R,0,3)
yuanhu1(-R,0,0,R,2)
}
void zhixianchabu()
{ int q1=0,q2=0
delay(300)
NX=shuzhi1()
delay(300)
NY=shuzhi2()
yj2()
Page_ = 0x00
Column = 0x25
Code_ = 0x10
WriteCHN8x16()
q1=NX/100
Page_ = 0x00
Column = 0x30
Code_ = q1
WriteCHN8x16()
q1=NX%100
q1=q1/10
Page_ = 0x00
Column = 0x37
Code_ = q1
WriteCHN8x16()
q1=NX%10
Page_ = 0x00
Column = 0x40
Code_ = q1
WriteCHN8x16()
q2=NY/100
Page_ = 0x00
Column = 0x50
Code_ =q1
WriteCHN8x16()
q2=NY%100
q2=q2/10
Page_ = 0x00
Column = 0x58
Code_ = q2
WriteCHN8x16()
q2=NY%10
Page_ = 0x00
Column = 0x60
Code_ = q2
WriteCHN8x16()
Page_ = 0x00
Column = 0x72
Code_ = 0x11
WriteCHN8x16()
zhixian(NX,NY )
}
void main()
{ int q=0,q1=0,q2=0
caas=mode
PA=0X00
PB=0X00
PC=0x00
R=0X00
while(1)
{
if(testkey())
{
delay1()
if(testKey())
{ delay1()
if(getkey()==15)
{
delay(300)
yuanhuchabu1()
}
else if(getkey()==10)
{ delay(300)
yuanhuchabu2()
}
else if(getkey()==13)
{
zhixianchabu()
}
else if(getkey()==1)
{
zhengx()
}
else if(getkey()==2)
{
fux()
}
else if(getkey()==3)
{
zhengy()
} else if(getkey()==4)
{
fuy()
}
}
}
if(GetKey()==12)
{ break}
}
}
欢迎分享,转载请注明来源:内存溢出
评论列表(0条)