motor._c

来自「MEGA16单片机程序包2」· _C 代码 · 共 45 行

#include "main.h"
//#include <iom16v.h>
//#include <macros.h>
void forward(void)
{
 DDRB=0XFF;
 PORTB=(0<<PB0)|(1<<PB1)|(1<<PB3)|(0<<PB4)|(0<<PB5)|(0<<PB6);
 }
 
 
void backward(void)
{
 DDRB=0XFF;
 PORTB=(1<<PB0)|(0<<PB1)|(1<<PB3)|(0<<PB4)|(0<<PB5)|(0<<PB6); 
}

void for_left(void)
{
 DDRB=0XFF;
 PORTB=(0<<PB0)|(1<<PB1)|(1<<PB3)|(1<<PB4)|(0<<PB5)|(1<<PB6); 
} 

void back_left(void)
{
 DDRB=0XFF;
 PORTB=(1<<PB0)|(0<<PB1)|(1<<PB3)|(1<<PB4)|(0<<PB5)|(1<<PB6); 
} 

void for_right(void)
{
 DDRB=0XFF;
 PORTB=(0<<PB0)|(1<<PB1)|(1<<PB3)|(0<<PB4)|(1<<PB5)|(1<<PB6); 
} 

void back_right(void)
{
 DDRB=0XFF;
 PORTB=(1<<PB0)|(0<<PB1)|(1<<PB3)|(0<<PB4)|(1<<PB5)|(1<<PB6); 
} 

void car_stop(void)
{
 DDRB=0XFF;
 PORTB=(0<<PB0)|(0<<PB1)|(0<<PB3)|(0<<PB4)|(0<<PB5)|(0<<PB6); 
}