step motor.c

微型电机的驱动

#include <ht46r51a.h>
#pragma rambank0
char mtp;
unsigned char highbit;
unsigned int percent_light;
unsigned int i,u;

#pragma vector isr_4 @ 0x4
#pragma vector isr_8 @ 0x8
#pragma vector isr_c @ 0xc
#pragma vector isr_14 @ 0x14 

//ISR for safequard

void isr_8(){} // timer/event 0

void isr_14(){_nop();
              _nop();
              _nop();} 

void isr_4()
{
}

void io_init()
{
 _pac=0x00;  // "1"=input
 _pa=0x00;
 _pbc=0xff;
 _pb=0x00;
}

char left_1(char left)
{
  char result;
  char mid;
  _acc=0x80;
  result=(_acc&left);
  _acc=result;
  mid=(left<<1);
   _acc=mid;	
  if(result)
   {_acc=_acc+1;
   }
  result=_acc;
  _pa=result;
  _pa=0x0f0;
 for(u=0;u<100;i++);
}
void main()
{
 
 char c_result;
 io_init();
 _pa=0x00;
 
 c_result=0x0f7;
 
  for(i=0;i<100;i++)
 {
  c_result=left_1(c_result);
  if(c_result==0x07f)
   { c_result=0x0f7;}
 }
}