|
|
#include "motor_bujin.h"
/****
******電機(jī)轉(zhuǎn)速調(diào)節(jié)
*****/
void StepDelay(unsigned int t)
{
unsigned int k;
while(t--)
{
for(k=0; k<80; k++)
{ }
}
}
/****
*******電機(jī)正轉(zhuǎn)函數(shù)
*****/
void Motor_Foreward()
{
unsigned int i;
for(i=0;i<256;i++)
{
GPIO_MOTOR_1 = 1;
GPIO_MOTOR_2 = 0;
GPIO_MOTOR_3 = 0;
GPIO_MOTOR_4 = 1;
StepDelay(1);
GPIO_MOTOR_1 = 0;
GPIO_MOTOR_2 = 0;
GPIO_MOTOR_3 = 0;
GPIO_MOTOR_4 = 1;
StepDelay(1);
GPIO_MOTOR_1 = 0;
GPIO_MOTOR_2 = 0;
GPIO_MOTOR_3 = 1;
GPIO_MOTOR_4 = 1;
StepDelay(1);
GPIO_MOTOR_1 = 0;
GPIO_MOTOR_2 = 0;
GPIO_MOTOR_3 = 1;
GPIO_MOTOR_4 = 0;
StepDelay(1);
GPIO_MOTOR_1 = 0;
GPIO_MOTOR_2 = 1;
GPIO_MOTOR_3 = 1;
GPIO_MOTOR_4 = 0;
StepDelay(1);
GPIO_MOTOR_1 = 0;
GPIO_MOTOR_2 = 1;
GPIO_MOTOR_3 = 0;
GPIO_MOTOR_4 = 0;
StepDelay(1);
GPIO_MOTOR_1 = 1;
GPIO_MOTOR_2 = 1;
GPIO_MOTOR_3 = 0;
GPIO_MOTOR_4 = 0;
StepDelay(1);
GPIO_MOTOR_1 = 1;
GPIO_MOTOR_2 = 0;
GPIO_MOTOR_3 = 0;
GPIO_MOTOR_4 = 0;
StepDelay(1);
}
}
/****
*****電機(jī)反轉(zhuǎn)函數(shù)
*****/
void Motor_Reversal()
{
unsigned int i;
for(i=0;i<256;i++)
{
GPIO_MOTOR_1 = 1;
GPIO_MOTOR_2 = 0;
GPIO_MOTOR_3 = 0;
GPIO_MOTOR_4 = 0;
StepDelay(1);
GPIO_MOTOR_1 = 1;
GPIO_MOTOR_2 = 1;
GPIO_MOTOR_3 = 0;
GPIO_MOTOR_4 = 0;
StepDelay(1);
GPIO_MOTOR_1 = 0;
GPIO_MOTOR_2 = 1;
GPIO_MOTOR_3 = 0;
GPIO_MOTOR_4 = 0;
StepDelay(1);
GPIO_MOTOR_1 = 0;
GPIO_MOTOR_2 = 1;
GPIO_MOTOR_3 = 1;
GPIO_MOTOR_4 = 0;
StepDelay(1);
GPIO_MOTOR_1 = 0;
GPIO_MOTOR_2 = 0;
GPIO_MOTOR_3 = 1;
GPIO_MOTOR_4 = 0;
StepDelay(1);
GPIO_MOTOR_1 = 0;
GPIO_MOTOR_2 = 0;
GPIO_MOTOR_3 = 1;
GPIO_MOTOR_4 = 1;
StepDelay(1);
GPIO_MOTOR_1 = 0;
GPIO_MOTOR_2 = 0;
GPIO_MOTOR_3 = 0;
GPIO_MOTOR_4 = 1;
StepDelay(1);
GPIO_MOTOR_1 = 1;
GPIO_MOTOR_2 = 0;
GPIO_MOTOR_3 = 0;
GPIO_MOTOR_4 = 1;
StepDelay(1);
}
}
|
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
