bujin.c

来自「步进电机的控制程序」· C语言 代码 · 共 64 行

#include <iom8v.h>
#include <macros.h>
#include <stdio.h>

void delay_1ms(void)
{
 unsigned int i;
 for(i=0;i<8*143-2;i++)
 ;
 }
 
void delay_ms(unsigned int n)
{
 unsigned int i=0;
 for(i=0;i<n;i++)
 {
  delay_1ms();
  }
 }

void delay_1us(void)
{
 asm("nop");
 }
 
void delay_us(unsigned int n)
{
 unsigned int i=0;
 for(i=0;i<n;i++)
 delay_1us();
 }
 

void port_init(void)
{
 PORTB = 0xff;
 DDRB  = 0xff;
 PORTC = 0x00; //m103 output only
 DDRC  = 0x00;
 PORTD = 0xff;
 DDRD  = 0xff;
}

void step(void)
{
  unsigned i;
  for(i=4;i<8;i++)
    {
     PORTD=~(1<<i);
	 delay_ms(3);
	 }
  }

void main(void)
{
 port_init();
 while(1)
 {
 step(); 
  }
 }