motor_2.c

二相四线制步进电机的驱动程序

#include <MSP430x14x.h>
#include <stdio.h>

void Init_Clk(void);          //时钟初始化
void Init_Port(void);         //端口初始化
void Delay_us(void);

/*端口初始化*/
void Init_Port(void)
{
 P4DIR = 0x0ff;    //P4设置为输出端口
 
 P4SEL = 0;        //P4设置为一般I/0口
 return;
}

void Delay_us()   //约30ms 8MHZ时钟时
{
  int nCount;
  int i;
  int j;
  nCount = 9;
  for( i = 10000; i > 0; i--)
   {
    for(j = nCount; j >0; j-- );
   }
  return;
}

int main(void)
{
 WDTCTL = WDTPW + WDTHOLD; //关闭看门狗
 _DINT();                  //关闭中断
 Init_Clk();               //时钟初始化
 Init_Port();              //端口初始化
 while(1)
 {
  P4OUT = 0X0F;
 }
}

/* 时钟初始化*/
void Init_Clk(void)
{
  unsigned int i;
  BCSCTL1 = 0X00;          //将寄存器的内容清零
                          //XT2震荡器开启
                          //LFTX1工作在低频模式
                          //ACLK的分频因子为1                       
  do
  {
   IFG1 &= ~OFIFG;      //清除OSFAULT标志
   for(i = 0X20; i >0; i-- );
  }
  while ( (IFG1 & OFIFG) == OFIFG ); //如果OSCFault = 1 
  BCSCTL2 = 0X00;
  BCSCTL2 +=SELM1;
  BCSCTL2 +=SELS; 
  return;
}