以下是步進電機的驅動原碼，實現正轉反轉，根據按鍵控制圈數
#include <reg52.h>
sfr P4 = 0xE8;
void KeyDriver();
void KeyScan();
signed long beats = 0; //電機轉動節拍總數
/* 步進電機啟動函數， angle-需轉過的角度 */
void StartMotor(signed long angle)
{
//在計算前關閉中斷，完成后再打開，以避免中斷打斷計算過程而造成錯誤
EA = 0;
beats = (angle * 4076) / 360; //實測為 4076 拍轉動一圈
EA = 1;
}
/* 步進電機停止函數 */
void StopMotor()
{
EA = 0;
beats = 0;
EA = 1;
}
/* 電機轉動控制函數 */
void TurnMotor()
{
unsigned char tmp; //臨時變量
static unsigned char index = 0; //節拍輸出索引
unsigned char code BeatCode[8] = { //步進電機節拍對應的 IO 控制代碼
0x6,0x7,0x3,0xb,0x9,0xd,0xc,0xe
};
if (beats != 0) //節拍數不為 0 則產生一個驅動節拍
{
if (beats > 0) //節拍數大于 0 時正轉
{
index++; //正轉時節拍輸出索引遞增
index = index & 0x07; //用&操作實現到 8 歸零
beats--; //正轉時節拍計數遞減
}
else //節拍數小于 0 時反轉
{
index--; //反轉時節拍輸出索引遞減
index = index & 0x07; //用&操作同樣可以實現到-1 時歸 7
beats++; //反轉時節拍計數遞增
}
tmp = P4; //用 tmp 把 P4 口當前值暫存
tmp = tmp & 0xF0; //用&操作清零低 4 位
tmp = tmp | BeatCode[index]; //用|操作把節拍代碼寫到低 4 位
P4 = tmp; //把低 4 位的節拍代碼和高 4 位的原值送回 P1
}
else //節拍數為 0 則關閉電機所有的相
{
P4 = P4 | 0xff;
}
}
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
