我的問題是在做步進電機時出現的問題是這樣的
1,在仿真中電機在轉到一定角度后就開始抖動,不在轉動,轉動角度差別太大
2,在實物上電機一直在抖動,不轉動。
求助解答,我的程序的問題在哪里
/***************/
#include <reg51.h>
#include "intrins.h"
typedef unsigned int u16;
typedef unsigned char u8;
#define MotorData P1 //步進電機控制接口定義
#define kai P2 //2*2的矩陣按鍵
u8 phasecw[8] ={0x01, 0x05, 0x04, 0x06, 0x02, 0x0a, 0x08, 0x09};//順時針轉
u8 phaseccw[8]={0x09,0x08, 0x0a, 0x02,0x06,0x04,0x05,0x01};//逆時針轉
u8 speed;
u16 num=0;
//ms延時函數
void Delay_xms(u16 x)
{
u16 i,j;
for(i=0;i<x;i++)
for(j=0;j<112;j++);
}
void delay(u16 i) //大概10us
{
while(i--);
}
//順時針轉動
void MotorCW(void)
{
u16 i;
for(i=0;i<4;i++)
{
MotorData=phasecw[i];
Delay_xms(speed);//轉速調節
}
}
void MotorCCW(void)
{
u16 i;
for(i=0;i<4;i++)
{
MotorData=phaseccw[i];
Delay_xms(speed);//轉速調節
}
}
//停止轉動
void MotorStop(void)
{
MotorData=0x00;
}
void kaiguan() //矩陣按鍵
{
char a=0;
kai=0x30;
if(kai!=0x30)
{
delay(1000);
if(kai!=0x30)
{
kai=0x30;
switch(kai)
{
case(0X20): num=2;break;
case(0X10): num=0;break;
}
kai=0x0c;
switch(kai)
{
case(0x04): num=num+1;break;
case(0x08): num=num+2;break;
}
while((a<50)&&(kai!=0x0c))
{
delay(1000);
a++;
}
}
}
}
//正轉
void zhuan(int N)//每個N轉2
{
u16 i;
Delay_xms(50);//等待系統穩定
speed=5;
for(i=0;i<N;i++)
MotorCW(); //順時針轉動
MotorStop();
Delay_xms(500);
}
void fzhuan (int N)//每個N轉2
{
u16 i;
Delay_xms(50);//等待系統穩定
speed=5;
for(i=0;i<N;i++)
MotorCCW(); //順時針轉動
MotorStop();
Delay_xms(500);
}
void main ()
{
while(1)
{
kaiguan();
switch(num)
{
case(1):zhuan(256);break;
case(2):fzhuan(128);break;
case(3):zhuan(21);break;
case(4):fzhuan(21);break;
}
num=0;
} }
|